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SUMMARY 


A Kalman filter for aircraft terminal area and landing 
navigation was implemented and flight tested in the NASA Ames 
STOLAND avionics computer on board a Twin Otter aircraft. 

This system combines navaid measurements from TACAN, MODILS, 
air data, baro-alt imeter , and radar altimeter sensors with 
strap-down accelerometer measurements and attitude angles 
obtained from the attitude and heading reference gyros. 

The flight test consisted of five approach, landing, 
and climbout profiles. The aircraft position and velocity 
were estimated simultaneously by both the Kalman filter and 
the regular STOLAND complementary filter. The errors in 
position and velocity, as determined by tracking radar, were 
used to evaluate and compare the two filters' performances. 

Post flight simulation studies were also made to identify an 
improved configuration of the Kalman filter. 

It was shown that it is feasible to use a Kalman filter 
during the landing phase of flight for navigation computa- 
tions. It was found that the Kalman filter improves the 
accuracy of the state variable estimates to some extent. The 
test pilot reported that on one of the flight profiles, one 
of the best localizer tracking performances that he had ever 
observed was obtained with the Kalman filter engaged. However, 
the computer implementation requirements of the Kalman filter 
are somewhat larger than those of the standard complementary 
filter. The results of this study form the basis for current 
and future navigation studies conducted at NASA Ames Research 
Center. 
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I 


INTRODUCTION 


Objectives 

This report describes the design and flight test results 
of a Kalman filter used for aircraft terminal area and land- 
ing navigation. The research was conducted using the NASA 
Ames STOLAND avionics system as a test bed for the Kalman 
filter implementation. The navigation aids used in the sys- 
tem include TACAN for the terminal area phase and MODILS (a 
low-cost experimental version of the Microwave Landing 
System (MLS)) for the final approach and landing phase. 

Other navaid information used from on board sources include 
air data, barometric altitude and radar altitude. The 
Kalman filter combines the navaid information with that from 
a low accuracy inertial reference system comprised of a con- 
ventional attitude and heading reference (vertical and direc- 
tional gyros) and a three-axis strapdown (body mounted) 
accelerometer package . 

One of the prime objectives of the study effort was to 
demonstrate that the Kalman filter used for terminal area 
navigation could be mechanized in a manner such that the com- 
puter requirements are not prohibitive. This was demonstrated 
by having a Kalman filter operating in parallel in the same 
airborne computer where the STOLAND system r s normal functions 
of navigation, guidance, control, and display were also being 
performed. As is seen later in this report, the Kalman fil- 
ter outputs can be used to drive display and guidance logic 
with sufficient accuracy for automatic landing of the air- 
craft . 

In the landing sequence of the aircraft, the measurement 
processing rate needs to be moderately high in order to pro- 
vide the required navigation accuracy. Algorithms referred to 
as complementary filters have been employed [1,2] in the 
STOLAND system to combine dead-reckoning and position measure- 
ment data. These algorithms require only a modest number of 
computer operations. Hence, the complementary filters can 
typically process the position measurements at the high fre- 
quency rate. Because the complementary filters exist as a 
part of the normal STOLAND navigation system, the navigation 
performance, computation cycle, and memory requirements of 
the Kalman and complementary filters could directly be com- 
pared. 



The Kalman filter was previously used in the experiment- 
al RAINPAL system [3,4] which demonstrated that the high 
navigation accuracy required for automatic landing is achiev- 
able when using an accurate inertial (platform-based) system 
and precision ranging navaids. The system described herein 
used a number of Kalman filter mechanization details devel- 
oped for the RAINPAL system such as: 

(a) the square root implementation, 

(b) computer time-sharing logic for maximizing available 
machine time for the filter, and 

(c) approximations and logical implementations which 
save computer operations. 

The distinction of the navigation system using the Kalman 
filter described in this report is the lower accuracy of the 
inertial (strapdown -based) system and the navaids used by the 
filter. 


Background 

This research originally began [5] with the design of a 
simple Kalman filter to operate in the horizontal (x-y) plane 
for potential use in a STOL aircraft landing navigation system. 
Computer simulation results (based on artificially generated 
approach trajectories and instrument errors) showed that the 
Kalman filter produced much smaller navigation errors than 
did a complementary filter using TACAN data. The same result 
occurred during transition from TACAN to scanning beam ILS 
(MODILS) data. The Kalman filter was shown to gain its 
superior performance at the expense of real time computation 
and memory required. However, these additional computer 
requirements were not considered excessive. 

Because of these encouraging results, the Kalman filter 
was expanded to include the vertical axis [6] . The resulting 
three-axis Kalman filter was designed to be interfaced with 
the displays and controls of STOLAND. The filter design was 
then validated on the NASA Ames CDC 7600 computer using 
recorded flight data. The error characteristics of both the 
Kalman filter and STOLAND complementary filter were compared 
and discussed. In addition, a comprehensive study effort has 
been undertaken by NASA Ames scientists on the application of 
Kalman filtering to terminal area navigation. This more gen- 
eral study effort confirms that the particular design selected 
for this effort is appropriate for the STOLAND system. Docu- 
mentation of this NASA study will appear at a future date. 



As a result of the success of these three efforts, it 
was decided to mechanize the three-axis Kalman filter in the 
STOLAND system, and then to flight test it on the NASA Ames 
Twin Otter aircraft. This study was designed to examine in 
detail the performance and implementation requirements of 
using a Kalman filter for terminal area navigation. This 
report summarizes the filter designs, documents the results 
of the flight tests, and presents further post-flight analy- 
ses. 


Report Overview 

Chapter II of this report presents the notation used 
throughout the report, and it defines various symbols, 
acronyms, and abbreviations. 

In Chapter III, the on board test system used in the 
study is described. This includes discussion of the STOLAND 
avionics system and its associated complementary filters. 

Also included are a brief general description of the three- 
axis Kalman filter used in the study and a comparison of the 
implementation requirements for the Kalman and complementary 
filters. 

In Chapter IV, the flight test results are presented. 
These include descriptions of the test facilities, data pro- 
cessing procedures, flight data collected, test results, and 
pilot comments. 

In Chapter V, post flight studies to explain test anoma- 
lies and to improve filter performance are explained. 

Chapter VI presents some concluding remarks. 

Appendix A gives the mathematical details of the Kalman 
filter used in this study, and Appendix B presents some of 
the on board mechanization details. 

This work was carried out for NASA Ames Research Center 
under the technical management of Mr. Rodney Wingrove, The 
STOLAND flight system used in the tests was under the direc- 
tion of Mr. Don Smith. The NASA test pilot responsible for 
the overall evaluation on the STOLAND system simulator and 
for the flight tests was Mr. Gordon Hardy. The authors wish 
to express appreciation to the above individuals for their 
contributions in the overall development and flight tests of 
the Kalman filter system described herein. 
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II 


NOTATION AND DEFINITIONS 


Notation 

The notation of over a symbol has the customary 

meaning of differentiation with respect to time. The 
(hat) mark over a symbol means the "estimated" or "computed" 
value of the symbolized quantity. The letter "d" before a 
quantity indicates an error or small variation of that quan- 
tity. For example, if X is the true value of position, it 
may be written as the sum of the estimated position and the 
position error, or 

X = X + dx . 


The notation t, , t, , etc., are used to denote discrete 
k’ k+1’ 

points in time. The time point t, , occurs At seconds 
after t fe , or 


t 


k+1 


t k + At 


The time differential At denotes the primary cycle time of 
the implemented digital filter. 

Other notations include: 


T 

( ) = transpose of matrix; 

E{ } = expected value of enclosed quantities; 

( ) ,( ) = matrix referred to the x-y portion of the Kalman 
^ filter and matrix referred to the decoupled z 
portion of the filter; 

( ) , ( ) h = computed quantity after (a) and before (b) an 
a update is added; 

( ) = residual, or difference between what is consid- 

ies ered the correct value of a quantity (e.g. , 

determined by tracking radar) and the value 
determined from the filter. 
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Roman Symbols 


discrete form of the matrix F . 

x 

sura of raw acceleration measurements and 
estimated acceleration biases. 


aircraft acceleration measured in body axes. 

temporary matrices used to update the square 
root covariance W . 

acceleration measurement biases. 

estimates of acceleration measurement biases. 

actual and estimated bias errors in the baro- 
metric altitude measurement. 

actual and estimated bias error in the TACAN 
range measurement. 

actual and estimated bias error in the TACAN 
bearing measurement. 

constant used to test reasonableness of a 
measurement residual . 

position and velocity smoothing vectors, 
the n element continuous error state vector 

A 

of the estimate X. 

filter estimate of the error state vector dx . 

nxn system dynamics matrix. 

nxm error distribution matrix. 

external measurement distribution (sensitiv- 
ity) matrix. 

sensitivity vectors of true airspeed compon- 
ents to estimated state. 


H - sensitivity vector of altitude derived from 

b the MODILS elevation measurement to estimated 

state . 
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H 


h 


sensitivity vector of baro-alt itude to esti- 
mated state. 


H 


ma 


sensitivity vector of MODILS azimuth to esti- 
mated state. 


H 


mr 


sensitivity vector of MODILS range to esti- 
mated state. 


H 


ms 


accumulated measurement sensitivity matrix. 


H 


r 


sensitivity vector of radio altimeter measure- 
ment to estimated state. 


H 


tb 


sensitivity vector of TACAN bearing to esti- 
mated state. 


H. 


tr 


h B’ h E 


K 


m 


k, 

lx 4x 


sensitivity vector of TACAN range to estimated 
state . 

baro-alt itude and radio altitude. 

runway altitude with respect to sea level. 

altitude above the TACAN station. 

identity matrix. 

- Kalman filter gain matrix. 

complementary filter gains for the x direc- 
tion . 


k 


i -k . 

lz 4z 


Kalman and complementary filter gains for the 
z direction. 


N, 


M 


P 

Q 

^ax ’ ^ay 


- magnetic north. 

number of residuals in a sum. 

covariance matrix of the error state dx. 

assumed variance of the random error q. 

assumed variances of air data measurement 
noise. 


Q 


e 


assumed variance of MODILS (elevation derived) 
altitude measurement. 
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assumed variance of baro-alt itude noise. 


% 


Sn 


a 


assumed variance of MODILS azimuth measure- 
ment noise. 


Snr 


assumed variance of MODILS range measurement 
noise . 


Q 


r 


assumed variance of radio altimeter noise. 


Q 


s 


assumed variance of random error in the 
accumulated residual. 


Q tb 

- assumed 
noise . 

variance 

•Qtr 

- assumed 
noise . 

variance 


of TACAN bearing measurement 
of TACAN range measurement 


Q - variance of an individual measurement. 


q 


random noise error in the external measure- 
ment . 


q ,q - random noise in the air data measurements. 

4 ax’ ^ay 

q - random noise in the MODILS (elevation derived) 

e altitude measurement. 


q 


h 


random noise error in the baro-alt itude 
measurement . 


q 


ma 


random noise error in MODILS azimuth measure- 
ment . 


q_ 

mr 


random noise in MODILS range measurement. 


random noise in the radio altimeter measure- 
ments. 


q tb 


random noise error in the TACAN bearing 
measurement . 


random noise error in the TACAN range measure- 
ment . 


R 


s 


TACAN or MODILS measured slant range. 
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MODILS slant range and its component in the 
x-z plane. 

TACAN measured ground range. 

variance of the accumulated residual of an 
individual measurement . 

t ime . 

standard deviation of u. 

a constant vector over the time interval At 
for approximating the effect of the random 
vector r| . 

true airspeed. 

smoothed velocity vector. 

estimated velocity vector. 

ground velocity components along, normal, 
and vertical to runway. 

estimates of v ,v ,v . 

x' y ’ z 

the square root of P. 

wind velocity components along and normal to 
runway . 

estimates of w x ,w y . 

actual and estimated values of the aircraft’s 
state vector. 

position of aircraft in a Cartesian reference 
frame with x along the runway, y in the 
horizontal plane normal to the runway, and z 
normal to the horizontal plane and positive 
pointing downward. 

filter estimates of x,y,z. 

location components of the MODILS elevation 
antenna with respect to the runway reference 
frame. 



x e’ y e’ Z e 

# • 


aircraft position coordinates with respect to 
the MODILS elevation antenna. 

A A 

x a’ y a 

- 

horizontal true airspeed components in the 
runway reference frame . 

x m ’ y m ’ z m 

— 

location components of the MODILS transponder 
and scanner with respect to the runway refer- 
ence frame. 

x r ,y r ,z r 

- 

aircraft position coordinates with respect 
to the runway reference frame. 

x r ’ y r ’ z r 

- 

raw acceleration in the runway reference frame 
as computed by STOLAND system software. 

x r 

- 

estimated position vector. 

A 

x s 

- 

smoothed position vector. 

x t 9 

— 

location components of the TACAN ground sta- 
tion with respect to the runway reference 
frame . 

A 

Y 

- 

computed value of the external measurement. 

Y , Y , 

ay’ 

Y Y 
ax’ ay 

- 

actual and estimated x and y components 
of true airspeed. 

/V 

Y Y 
e’ e 

- 

actual and estimated MODILS altitude measure- 
ments. 

Y 

m 

- 

external state measurement of aircraft. 

Y , Y 
ma ma 

- 

actual and estimated MODILS azimuth measure- 
ments. 

A 

Y Y 

mr’ rar 

- 

actual and estimated MODILS range measure- 
ments. 

Y , Y 
r r 

- 

actual and estimated radio altimeter measure- 
ments. 

A 

Y Y 

x tb* tb 

- 

actual and estimated TACAN bearing measure- 
ments. 

A 

Y Y 

*tr’ x tr 

- 

actual and estimated TACAN range measurements. 
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y m - discrete measurement residual. 

A 

y m - computed value of the position measurement 

J residual based on the error state estimate dx. 

y^y.™ - accumulated residual Ay. 

S bill 


a ,P 


Y 

At 


Greek Symbols 

constants used to compute smoothing vectors 
c x and c v . 

estimated flight path angle 

major time (cycle) update period of the Kalman 
filter. 


At . 


Ay 

A\j/ 


e , * 
*1 


acceleration integration period of the filter. 

commanded change in airspeed. 

error in the estimated residual y . 

m 

difference between the TACAN measured bear- 
ing and the bearing of the runway. 

MODILS elevation angle measurement. 

vector of m random forcing functions for 
compensation of error growth caused by un- 
modeled error sources. 

time constant for acceleration measurement 
colored noise. 


- time constant for barometric altimeter meas- 
urement colored noise. 

t r - time constant for TACAN range measurement 

colored noise. 


w 


time constant for wind error measurement 
colored noise. 


V 


time constants used to compute smoothing 

vectors c and c . 

x v 

time constant for TACAN bearing measurement 
colored noise. 
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a ,a 
ax’ ay 


hb 


hr 


m 


qr 

r q\|/ 


va 


vz 


a ,a 
wx wy 


•(‘ktiiV 

Wi^V 


cp.e,'!' 


‘Pc^c 

*M 

♦r*+RW 


standard deviation (std) of acceleration 
colored noise, 

std of barometric altitude colored noise 
(bias) . 

std of barometric altitude random noise, 
std of the m^h residual sum y 

sm 

std on TACAN range random noise. 

std in TACAN bearing random noise. 

std of TACAN range colored noise (bias). 

std of velocity noise. 

std of air data velocity noise. 

std of vertical airspeed error. 

std of wind colored noise (bias) components. 

std of TACAN bearing colored noise (bias). 

std in initial heading measurement. 

state transition matrix from time point t^ 
to time point t^ + ^ . 

forcing function sensitivity matrix affecting 
state at t k+ ^ due to u(t fe ). 

aircraft attitude angles (roll, pitch, head- 
ing) measured by vertical and directional 
gyros. 

commanded aircraft attitude. 

MODILS azimuth measurement. 

bearing of runway with respect to magnetic 
north. 

TACAN measured bearing from magnetic north. 
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Abbreviations and Acronyms 


EADI 

HSI 

MFD 

MODILS 

RAINPAL 

std 

STOLAND 

TACAN 


Electronic Attitude Director Indicator. 

- Horizontal Situation Indicator. 

- Multifunction Display. 

mobile, scanning beam instrument landing 
system. 

- recursived aided inertial navigation for pre 
cision approach and landing. 

standard deviation. 

integrated avionics system for STOL aircraft 

tactical aircraft navigation aid, providing 
range and bearing measurements. 
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TEST SYSTEM DESCRIPTION 


This chapter first presents a brief summary of the 
STOLAND flight test system which was used to conduct the 
study described in this report. This summary includes an 
overview of the STOLAND system avionics and a description of 
its complementary filters normally used for terminal area 
navigation. This is followed by a summary of the design 
considerations and a brief description of the Kalman filter 
which was added to the STOLAND software to provide the experi- 
mental, alternate terminal area navigation system which is the 
subject of this study. Then, the computer mechanization 
requirements for implementing the Kalman filter and the com- 
plementary filter are compared. 


The STOLAND System 

General description .- The NASA Ames STOLAND system is an 
integrated digital avionics package designed for testing ter- 
minal area guidance, navigation, control, and display concepts 
and for investigating operational procedures for short-haul 
aircraft [7-9] . The STOLAND system can be tested in either 
the Ames Augmentor Wing or the Twin Otter STOL aircraft. 

Flight tests of this system are typically conducted at the 
NASA Ames Crows Landing facility in central California where 
tracking radar is provided. 

Figure 1 presents a pictoral description of the main 
units of the STOLAND flight test system. The subsystem inter- 
connections are illustrated in further detail by the block 
diagram in Fig. 2. The general computational flow of the 
navigation, guidance, and flight control functions are depict- 
ed in Fig. 3 [9] . 

As is illustrated in Figs. 1-3, the STOLAND system has a 
moderately large number of navaid receivers, on board sensors, 
and pilot control and command inputs which are interfaced 
with the Sperry 1819A airborne computer. This computer is 
the heart of the overall mechanization, and it is used to 
provide both pilot assist modes and completely automatic 
modes for flying the aircraft. The computer is interfaced 
with various displays (EADI, MFD, HSI), control sensors, mode 
select and data entry panels, steering column, navaids 
(TACAN, MODILS), vehicle sensors, and the data acquisition 
system through a data adapter. 
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EADI - Electronic Attitude Director Indicator 
HSI - Horizontal Situation Indicator 
MFD - Multifunction Display 


FIGURE 1.- PICTORAL DESCRIPTION OF THE STOLAND FLIGHT TEST SYSTEM 
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FIGURE 2,- BLOCK DIAGRAM OF THE STOLAND SYSTEM 

COMPONENTS [8] 
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FIGURE 3.- SIMPLIFIED FLOW OF STOLAND COMPUTATION FUNCTIONS [8] 






The Sperry 1819A computer used in the STOLAND system 
implementation contains 32,768 words of 18-bit memory. The 
speeds of individual operations for single and double preci- 
sion fixed point arithmatic on the 1819A are as follows: 


Operation 


Time (psec) 


ADD (Single) 4 
ADD (Double) 6 
Multiply (Single) 24 
Divide (Single) 24 
LOAD and STORE (Single) 4 
LOAD and STORE (Double) 6 


The STOLAND 1819A software is divided into many functions 
which are presented in Table 1 [9] . Also shown in this table 
are the computation rate at which each of these functions is 
performed, the real time consumption required for each func- 
tion, and the memory usage division among the functions. 

Note, in particular, that the STOLAND system navigation func- 
tion, performed at a rate of 20 Hz, requires 0.12 sec of 
execution time for every one second of real time operation, 
and it requires 1,066 memory words. 

Also, note in Table 1 that there are about 165 msec of 
real time available each second and 10,000 words of memory 
that are unused which can be used for additional avionics 
functions. This available time and memory were used to 
implement the Kalman filter based navigation software. 

Complementary navigation filters . - The current STOLAND 
navigation system consists of Sperry designed complementary 
filters [2] which combine raw measurement data from external 
navigation aids (TACAN, MODILS), with on board sensors (air 
data, radar altimeter, linear accelerometer, and altitude 
and heading reference). The STOLAND navigation equations 
provide position and velocity of the aircraft with respect to 
a runway-fixed Cartesian coordinate system. 

Figure 4 is a planar view of the Crows Landing test 
facility where the test flights were conducted [1]. The 
coordinate system has its origin at the center of the runway 
and the intersection of the perpendicular from the position 
of the scanning beam ILS receiver (MODILS) elevation antenna 
(glideslope) to the runway centerline. The x axis is along 
the runway centerline, the y axis is away from the MODILS 
elevation antenna, and the z axis is downward, completing 
the Cartesian set. 
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TABLE 1.- STOLAND SOFTWARE SUMMARY [8] 


Function 

Time/ 

Solution 

(nsec) 

Iteration 

Rate 

Time 

Consumption 

(msec/8ec) 

Memory 

Usage 

(words) 

Hatter Executive and Timing 

1.2 

20/sec 

24.0 

374 

Input/Output 

5.6 

20/sec 

112.0 

339 

Monitors and Diagnostics 

1.5 

20/sec 

30.0 

619 

Keyboard and Status Panel 
Humber Entry 

.052 

20/sec 

1.04 

1,453 

Decode/Display 

2.304 

20/sec 

46.08 


Hode Select panel and Mode 
Interlocks 

1.3 

10/sec 

13.0 

1,762 

Navigation 

6.0 

20/sec 

120.0 

1,066 

Air Data Computation 
0>. V C. V T , Q. Tl, T S ..) 

1.3 

20/sec 

26.0 

132 

Attitude Stabilization Control 
Stick Steering and Flight 
Director 

3.7 

20/sec 

74.0 

880 

Autopilot and Autopilot Execu- 
tive (Includes Trim Tables) 

4.0 

20/sec 

80.0 

3,134 

Electronic ADI (including 
Runway Perspective Display) 

4.19 

20/sec 

83.8 

561 

3-D Guidance 

2.0 

10/sec 

20.0 

1,785 

4-D Guidance 

1.2 

•l/sec to 
10/sec 

12.0 

(max) 

1,304 

Multifunction Display (MFD) 

6.0 

1.0/sec 
and 20/sec 

120,0 

(max) 

3.636 

Horizontal Situation Indicator 

2.3 

10/sec 

23.0 

230 

Magnetic Tape and Digital Data 
Acquisition 

1.2 

20/sec 

24.0 

495 

Speed Control. •• • Autothrottle 
Flap, Nozzle, etc 

1.4 

20/sec 

28.0 

556 

Data for all Modules (except 
3D-4D and MFD) 

— 

— 

— 

3,542 

Totals 



835.92 

absolute 

max 

21,868 

Frefllght Central Integrated 
Test 




2,558 
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MODILS 



FIGURE 4. PLANE VIEW OF CROWS LANDING TEST FACILITY 
SHOWING THE REFERENCE COORDINATE SYSTEM 
AND THE NAVA ID LOCATIONS [1] 
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Figure 5 defines the coordinates of the TACAN station 

which provides measurements of slant range R and bearing 

s 

\]/ T with respect to the aircraft. The geometry of the MODILS 

system is depicted in Fig. 6. MODILS provides measurements 

of slant range R , azimuth vji and elevation e. Both 

s M 

MODILS antennas have conical scans. The elevation antenna is 
tilted 5° above the horizontal plane. 

A block diagram of the STOLAND navigation computation 
sequence is shown in Fig. 7. Navaid position data and body 
accelerations are transformed to components in the runway 
reference coordinate frame where they are filtered in separate 
x, y and z complementary filters. Again, the on board 
sensors used for navigation measurements are the TACAN receiv- 
er and the MODILS receiver, a body-mounted accelerometer 
package, the pitch, roll, and heading angles from the attitude 
and heading reference system, barometric altimeter , radio 
altimeter, and an airspeed sensor. The navigation subroutines 
develop estimates of position and velocity with respect to 
the local runway-fixed coordinate frame. In conjunction with 
air data, a wind vector is also estimated for use in the 
guidance computations. In case of navaid failure, the comple- 
mentary filters are reconfigured for dead reckoning for a 
maximum of two minutes using air data and the last wind esti- 
mate. 


Figure 8 presents a schematic diagram of the STOLAND 

complementary filter for estimating aircraft position x and 

* 

velocity x components along the runway centerline axis [2] . 

A similar filter configuration is used for computing y and 

normal to the runway. Note, in Fig. 8, that the acceleration 

measurement x , the airspeed measurement x , and navaid 
r a 

position measurement x r are input and blended in the filter 
to produce the smoothed estimates. 

Figure 9 illustrates the complementary filter which is 

• 

used for computing the vertical position z and velocity z 
components. It has a slightly different configuration than 
do the x-y filters, and it uses altimeter and MODILS eleva- 
tion derived altitude data for updating the estimated vari- 
ables. A complete discussion of these filters is found in 
Ref. 2. 

The roll, pitch and heading measurements from attitude 
gyros are used to compute the transformation matrix from 
aircraft body-fixed axes to the runway reference system. 
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GROUND RANGE 


FIGURE 5.- DEFINITION OF TACAN COORDINATES IN THE 
RUNWAY COORDINATE FRAME [1] 



FIGURE 6.- GEOMETRY OF MODILS CONICAL SCAN ANTENNAS USING THE 
RUNWAY-ORIENTED COORDINATE SYSTEM [1] 
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FIGURE 7.- BLOCK DIAGRAM OF STOLAND SYSTEM NAVIGATION 

COMPUTATIONS [1] 
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FIGURE 9. SCHEMATIC OF STOLAND Z-COMPLEMENTARY FILTER [2] 



This tranformation , in turn, is used with the accelerometer 
measurements to calculate the acceleration components x 


'r* 


and in the runway reference system. 


r 9 

The raw navaid 


measurements are used to compute, for example, the position 
vector component x r , in Fig. 8. The error between the 

measured position vector x r and the estimated position vec- 
tor component is fed back with the gains k lx , (or ) , 

k 2x’ and k 3x J as illustrated in Fig. 8 - Basically, there 

are eleven state variables in the three complementary filters — 
three components of each position, velocity and acceleration 
bias, plus two components of the estimated wind. 


In the complementary filter implementation (see Ref. 2), 
the gains are either fixed or dependent on the range and 
bearing of the aircraft from the navaid station. Also, there 
is logic for: (a) the dead reckoning mode (when navaid 

measurements either are not available or are rejected), and 
(b) navaid selection. The complementary filter combines the 
inertial data with the navaid measurement data to give filter- 
ed velocity and position information. 


The attitude reference system used in the STOLAND system 
develops moderately large errors in attitude during turns of 
the aircraft. This is the prime error source in the computed 
acceleration. Also, the accelerometers are not inertial grade 
equipment; the resulting accelerometer errors and error in 
the assumed gravity magnitude (which is assumed constant) also 
contribute to errors in the computed acceleration. The esti- 
mated acceleration biases are used to provide some compensa- 
tion for these error sources. The filter gains are selected 
as a compromise in blending the low frequency acceleration 
errors and the high frequency noise errors of the raw navaid 
measurements. As is seen later, the STOLAND system comple- 
mentary filter is able to provide adequate accuracy in posi- 
tion and velocity for automatic landing of the aircraft. 


The Kalman Filter 

Design considerations . - The selection of an appropriate 
Kalman filter configuration for testing in the STOLAND system 
involved the following considerations: 

(1) The computer memory and real time available in the 
STOLAND system were quite restrictive. At the 
initiation of the study, it was believed that if 
the Kalman filter design required no more than 
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3000 words of memory or 20% of real time, then the 
1819A computer could accommodate the mechanization. 

(2) The Kalman filter design could be set up into two 
different forms, as follows: 

(a) Actual calculation and updating of the covari- 
ance matrix in accordance with theory, and use 
of approximations consistent with the computer 
memory and computer time restrictions. 

(b) Elimination of the covariance matrix computa- 
tions by use of the theory to develop the 
feedback structure, and use of piecewise con- 
stant (or state dependent) gains. 

Because this was a research investigation, either 
approach could have been chosen . Approach ( b ) would 
have resulted in a less demanding filter from memory 
and real time considerations. It would provide a 
configuration very nearly the same as the comple- 
mentary filter. However, it would be very special- 
ized to only the terminal area and landing phase of 
flight. Approach (a) was selected for the investiga- 
tion because proof of its applicability for landing 
usage would prove its applicability for all phases 
of flight. The discrete square root form of the 
Kalman filter [10] was used because of its mechani- 
zation advantages . 

(3) The accuracy of the STOLAND system inertial measure- 
ments degrades substantially in going from level 
flight into turns. A good mathematical model of 
these error characteristics was not available, so 
the filter design needed to be somewhat ad hoc in 
the manner of obtaining compensation for these char- 
acteristics . 

(4) As the aircraft passes from enroute to the landing 
phase, the accuracy of the navigation aids (TACAN 
to MODILS) was expected to improve substantially. 

In the present study, TACAN range and bearing and 
barometric altitude were used in the terminal area 
mode. Transition from using the TACAN measurements 
to more accurate MODILS range and azimuth data 
occurred prior to the turn onto the final approach. 
Transition from barometric altitude to altitude 
determined from MODILS elevation data occurred on 
the final approach. Transition from MODILS eleva- 
tion to radio altitude occurred below 30 m (100 ft). 



The Kalman filter had to be designed to provide 
smooth transition in going between these different 
sources of position measurement information. 

The Kalman filter used in this study was developed in 
stages, as is discussed in Refs. 5 and 6. This allowed the 
above considerations to be incorporated into the filter 
design which was flight tested. 

System description . - The Kalman filter, as mechanized 
within the STOLAND system, is depicted in Fig. 10. As can be 
seen, the added blocks include the navigation equations, the 
x-y filter, the z filter, and the smoothing logic. 

The filter equations were originally developed for the 
horizontal plane [5] (x-y filter) and then for the vertical 
direction (z filter) [6] . It proved to be efficient to main- 
tain this decoupling in the mechanization . 

The equations which were used to develop the Kalman 
filter design are presented in detail in Appendix A. These 
are summarized in Table 2. The equations were divided and 
mechanized into three priority levels as shown in this table. 
They are referred to as Foreground, First Level Background, 
and Second Level Background equations. An explanation of how 
the available real time of the STOLAND system is divided to 
mechanize the three priority levels is given in Appendix B. 

The Foreground (Navigation) equations are used to inte- 
grate the accelerometer readings at a high rate (20 Hz). The 
First Level Background equations accumulate and preprocess 
the position and air data measurements at one-half (10 Hz) 
the integration rate. 

There was not sufficient real time available to execute 
the entire Kalman filter equations at this speed. Thus, the 
majority of the Kalman filter computations were distributed 
over the remaining real time available during a 1.5 sec 
period (0.667 Hz). These Second Level Background computations 
are listed in Table 2, and they are explained in Appendix A. 

At the end of every 1.5 sec period, there is a discrete 
update to the estimated state variables based on processing 
external measurements by the Kalman filter. These updates 
could cause undesirable jumps in the estimates, from a usage 
(display, control) point of view. Thus, the smoothing logic 
shown in Fig. 10 was added to take out the abrupt changes. 

This logic is explained in Appendix A. Further details on 
interfacing the Kalman filter with the STOLAND system and 
initialization of the filter are also presented in Appendix 
A. 
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1819A COMPUTER 



FIGURE 10.- BLOCK DIAGRAM OF THE KALMAN FILTER MECHANIZATION WITHIN THE 

STOLAND 1819A COMPUTER. 




TABLE 2. - SUMMARY OF MECHANIZED KALMAN FILTER EQUATIONS 


RATE 
20 Hz 

(Foreground) 


THE EQUATIONS SOLVED IN THE 1819A COMPUTER ARE SUMMARIZED BELOW 

EQUATIONS EXPLANATION 

(A* 0,05 sec) . Update state equations (Navigation equations) 

x^t+A) * x^t) + (aj’ 3 + x 1+3 (t)] A update velocities i * 4-6 

x 1 (t + A) * x^t) + [x 1+3 (t + x* +3 (t)} A/2 update position 1*1-3 

x^t+A) * x^t) update states i = 7-14 


10 Hz 

(First Level 
Background) 


(A = Q.i sec) . Measurement preprocessing; executed for all valid measure- 
ments (k * 1-6) 


V * Y k - Y k 
y k * y k + ^y k 

H k - V x Y k 

= 

m 

H k - H k + H k 
s s m 


compute residual 
residual sum 

compute measurement gradi- 
ent (partial) 

refer partial to beginning of 
0.667 Hz cycle 

partial sum 


0.667 Hz 

(Second 

Level 

Background) 


(A * 1.5 sec) . 

s k * H s «« T < H s> T 

dx * dx + MW T {H^) T [yj-Hjdx]/S k 

T T w t (hS t hW 

h t * r - 5 - s 

[s k ( 1+ ^)i 


variance in residual 


update incremental state 
vector 


update square root covari- 
ance matrix 


Update incremental state and covariance matrix using Potter’s 
algorithm: Executed for each of the five measurements in 

effect ( M0D1LS or TACAN, air data* and altitude) 



Add incremental state to state estimates ( i = 1 -14) 

dx(t) * 4»dx refer state change to cur- 

rent time 


x 1 * x 1 + dx 1 
dx 1 * 0 

Update W T with forcing functions 


update states 


W ( t + A) * 




mV 

u * u 


W T (t+A) ■+ upper triangular form using Householder's algorithm. 
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One of the objectives of this study was to compare the 
performance of the Kalman filter to that obtained from the 
complementary filters which are a part of the regular STOLAND 
software. It is useful to note the differences of the two 
mechanizations at this time. In Figs. 8 and 9, the comple- 
mentary filters are depicted as being mechanized in a continu- 
ous fashion. This is essentially correct in that the integra- 
tions are mechanized digitally in the STOLAND software with 
an update rate of 20 Hz. 

The Kalman filter can also be described with continuous 
equations [11] . Then, these equations can also be placed in 
analog form, as is shown for the complementary filters. This 
is done for the z filter in Fig. 11. The basic form is 
essentially the same, as is discussed in Ref. 12. The primary 
differences are as follows: 

(1) The complementary filters have position dependent 
or fixed gains (e.g., k lx , k 2x , k 3x , k 4x in Fig. 8; 

k^, k 2z , kg z , k 4z in Fig. 9). The Kalman filter 

has continuously changing gains (e.g., k^ z , k 2z , 

^3z’ ^4z H)- These gains are computed 

to be optimal using the square foot covariance 
matrix. They are defined by Eqs. (A. 11) of Appendix 
A. 

(2) The complementary filters are essentially decoupled 
(e.g., x, y, and z filters). The Kalman filter 
takes advantage of natural coupling and has cross- 
coupling gains. This provides better accuracy at 
the cost of complexity. 

(3) The Kalman filter provides a systematic way of 
computing additional information which improves the 
accuracy of the output. This information is in the 
form of additional state variables which can be used 
to remove measurement errors. For this study, the 
Kalman filter provided three components of position, 
velocity, and acceleration bias and two components 
of the horizontal wind, as did the complementary 
filters. The Kalman filter also provided estimates 
of TACAN range and bearing measurement bias and 
baro-altimeter bias. 

Each of the above points allow the Kalman filter to pro- 
vide greater accuracy. The cost is greater mechanization 
complexity. 
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FIGURE 11.- SCHEMATIC ANALOG FORM OF KALMAN FILTER 
FOR VERTICAL DIRECTION. 


Comparison of Mechanization Requirements 

The three-axis Kalman filter mechanization used in the 
flight tests required approximately 3000 words of memory and 
18% real time availability of the 1819A computer. Minor 
modifications in the Sperry STOLAND display logic were made 
in order to obtain the required time for the Kalman filter. 

As was previously mentioned, the complementary filter requires 
1,066 words of memory and 12% real time availability of the 
1819A computer. These demands are not so large as to preclude 
the use of the Kalman filter in the operational sense. 
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IV 


FLIGHT TEST RESULTS 


To test the Kalman filter navigation system and to com- 
pare its performance with that of the STOLAND complementary 
filters, five different landing approaches (flight segments) 
were made using the system on Dec. 10, 1976. This chapter 
first describes the flight test facilities and data processing 
procedures, the data recorded during the tests, and the flight 
profiles flown. Then, the results of these tests are summar- 
ized. 


Flight Test Description 

The five test flight segments were made at the NASA 
Crows Landing NALF test facility near Mbdesto, Calif. This 
facility has a radar tracking system consisting of two modi- 
fied Nike-Hercules radars. The modification provides improved 
position resolution through the use of 19-bit range and angle 
digital shaft encoders. The flights were made using the NASA 
Ames Twin Otter aircraft. A transponder on board the aircraft 
was used to improve the radar angular tracking. 

A data recording system on board the aircraft was used 
to obtain the outputs from the STOLAND complementary and 
Kalman filters plus the raw measurements from the on board 
instruments. The instrument measurements included the TACAN 
bearing and range; the MODILS azimuth, elevation, and range; 
the true airspeed; the barometric and radio altitude; the 
x, y, and z body-mounted' accelerometer outputs; and the roll, 
pitch, and heading angles as measured by the vertical and 
directional gyros. Also, these data measurements were direct- 
ly telemetered to the ground and digitally recorded. Clocks 
on the aircraft and at the ground facility were initially 
synchronized so that the data recorded on the aircraft could 
also be directly correlated with that obtained from the 
ground-based radars . 

The radar position measurements were combined with the 
aircraft accelerometer measurements in complementary filters 
implemented in the post-flight data processing program. This 
filtering procedure was used to smooth the radar measurements 
and to derive good estimates of the aircraft T s actual position 
and velocity throughout each flight segment. These smoothed, 
radar derived trajectories were then used as the standard 
with which to assess the performance of the Kalman and comple- 
mentary filters. 


35 



The differences between the three components of position 
(x,y,z) and velocity (x,y,z) derived from the on board Kalman 
and complementary filters and the same components derived from 
radar were computed and compared. An assessment of this data 
was then made to evaluate the two filters' performances. 

The five segments flown consisted of a series of touch- 
and-go profiles. These profiles are shown in Figs. 12-16. 
These figures show each trajectory from a horizontal view 
(x-y plane) and a runway planar view (x-z plane). Discrete 
events, such as the transition point from TACAN range/bearing 
to MODILS range/azimuth measurements, are indicated on these 
profiles. The record of the navaid measurements (airspeed, 
altitude, MODILS range, bearing, and elevation) and inertial 
measurements (accelerometer and attitude gyro) for each of 
these profiles are depicted in Figs. 17-21 as a function of 
time. Figures 12-21 can be used to determine the unique 
features of each flight segment which affect the performance 
of the filters. 

The first flight segment, shown in Fig. 12, consisted of 
a typical approach, landing, and rollout sequence. In this 
test, the initial navigation information came from TACAN 
range and bearing measurements and the baro-altimeter . (In- 
formation from the baro-altimeter remained valid throughout 
this and all other flight segments.) At 130 sec past the 
initial point, the MODILS range and azimuth data became valid. 
(Both hardware discretes (range and azimuth) show valid data, 
and the azimuth angle becomes less than 20° . ) Thus, MODILS 
range and azimuth measurements replaced the TACAN data beyond 
this point for input to the x-y filter. At 202 sec past the 
initial point, the MODILS elevation information was accepted 
by the z filter. (The criteria for its acceptance is that 
the MODILS elevation valid flag must be true, the aircraft 
x-position (in the runway reference frame) must be more posi- 
tive than -10,856 m (-35,616 ft), and the aircraft heading 
angle with respect to the runway must be within +20° . ) At 
328 sec past the initial point, the radar altitude became 
less than 30.5 m (100 ft). Thus, beyond this point, it was 
used instead of the MODILS elevation measurements for input 
to the z filter. Touchdown occurred at 341 sec past the ini- 
tial point. 

The second flight segment, depicted in Fig. 13, began 
with the aircraft having a 49 m (160 ft) altitude shortly 
after take-off. The aircraft climbed out to about 457 m 
(1,500 ft) altitude, and it was positioned to begin a typical 
45° approach leg. Then, an approach and landing sequence was 
executed similar to that of the first segment (Fig. 12). 

During the landing portion, the aircraft descended to about 
12.2 m (40 ft) altitude after which it climbed out again. The 
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final portion of the trajectory consisted of a maneuver that 
put the aircraft again on the downwind leg of the approach. 

The MODILS range and azimuth measurements became valid at 
275 sec after initiation. The MODILS elevation data became 
valid at 331 sec. Between 333 sec and 337 sec, the MODILS 
range data were invalid (data dropout). The radar altimeter 
data were used beginning at 411 sec (altitude below 30.5 m 
(100 ft)). The x-y filter switched back to TACAN measurements 
at 421 sec. The TACAN data remained valid for use throughout 
the remainder of this flight segment. 

The third flight segment, shown in Fig. 14, began on the 
downwind leg of the approach and ended during the rollout 
phase. MODILS range and azimuth data became valid at 29 sec 
past the initial point. MODILS elevation data became valid 
at 79 sec. Radar altitude started being used at 155 sec. 
Touchdown occurred at 168 sec past the initial point. 

The fourth flight segment, shown in Fig. 15, began 
during a climbout at about 15.2 m (50 ft) altitude. This seg- 
ment consisted of climbout to 457 m (1,500 ft), positioning 
for a 45° approach leg, normal downwind, base, and final 
approach legs, landing, take-off, and climbout .again to 457 m 
(1,500 ft). The segment began with the filter using TACAN 
data. MODILS range and azimuth data became valid at 321 sec. 
MODILS elevation data became valid at 394 sec. However, the 
navaid selection was not switched by the pilot to MODILS until 
430 sec at which time the MODILS data were used. Radar alti- 
meter data were used between 516 sec and 551 sec. Touchdown 
was at 533 sec. Take-off was at 544 sec. The filters began 
using TACAN data again at 569 sec. 

The fifth flight segment, depicted in Fig. 16, consisted 
of a base leg, final approach, and landing. This segment 
began with the MODILS range and azimuth data being used by the 
x-y filter. At 23 sec past the initial point, the MODILS 
elevation data became valid, and they were used for altitude 
computations. At 149 sec, the radar altimeter data were 
accepted, and touchdown occurred at 161 sec. 


Flight Test Results 

Before the flight tests were conducted, two different 
outcomes were expected. First, it was thought that the gen- 
eral navigation accuracy would improve from both filters in 
going from TACAN data to MODILS data. This was because a 
TACAN system is designed to have accuracies adequate for 
enroute navigation usage, and MODILS is intended to provide 
precision terminal area navigation information. 
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Second, it was expected that the Kalman filter would pro- 
vide superior navigation information to that of the comple- 
mentary filter. This was because the Kalman filter was con- 
figured to estimate and compensate for TACAN range and bearing 
bias and baro-altitude bias. In the previous simulation study 
of the x-y filter [5], this proved to be the case. However, 
these simulation results were based on the assumption that 
large TACAN and baro-altitude bias errors were indeed present. 

Figures 22a-26a show the differences (residuals) between 
the three components of position and velocity, as obtained 
from radar measurement -derived estimates, and those components 
estimated by the Kalman filter, for each of the five flight 
segments. For example, for the x position .component , 


x res x radar x f ilter 


( 1 ) 


Figures 22b-26b show the corresponding residuals which were 
computed using the complementary filter estimates. Thus, the 
residuals of the two filters can be directly compared to get 
an indication of relative performance of the two methods. 

Figures 22a and 22b show the residuals from the first 
flight segment which consisted of a single approach and land- 
ing trajectory. The MODILS range and azimuth data became 
valid at 130 sec, the MODILS elevation data were valid at 202 
sec, the radar altitude was valid at 328 sec, and landing took 
place at about 341 sec past the initiation point. As can be 
seen from these plots, the complementary filter gave better 
results for the x-y components during the first 130 sec when 
TACAN data were used. This is contrary to what was expected 
because the Kalman filter was designed to remove TACAN bias 
errors. At the point where MODILS range and azimuth measure- 
ments became valid (130 sec), both filters produced excursions 
in the y,y residual components. During this transient 
period, the complementary filter, with higher fixed gains, 
had smaller residuals in magnitude. After the transient 
period, Fig. 22b indicates that the x, x, y, y residuals 
from the complementary filter had a higher frequency noise 
content with MODILS data (after 130 sec) than when TACAN 
data were used. This is also contrary to what was expected, 
because MODILS data should be less^ noisy than TACAN data. 

The velocity component residuals (x and y), based on MODILS 
data, varied more slowly and were much smoother with the 
Kalman filter. Thus, the Kalman filter velocity data are 
preferable from the pilot usage point-of-view in that the 
displays and guidance commands are smooth. The two filters 
produced essentially equivalent results for the z,z residu- 
als up to a point just before touchdown where the Kalman fil- 
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FIGURE 24.- FILTER ERRORS FOR THIRD SEGMENT 
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ter estimates deviated for about 30 sec before reconverging. 
The cause of the large vertical error was never completely 
isolated. Except for this particular anomaly in the vertical 
channel, it can be seen that the two filters produced about 
the same overall levels of accuracy for the first flight 
segment . 

Figures 23a and 23b show the residuals for the second 
flight segment which began by using TACAN data. Many differ- 
ent interrelated events occurred during this flight segment, 
so they are first explained before the filter results are 
discussed. In this second segment, the MODILS range and azi- 
muth data became valid at 275 sec, the MODILS elevation data 
became valid at 331 sec, the radar altitude data were valid 
at 411 sec, and TACAN data were valid to be used again begin- 
ning at 421 sec. The MODILS range measurements (R ) became 

s 

invalid (drop out) temporarily for about 4 sec beginning at 
333 sec. 

As noted in Fig. 23a, the Kalman filter was placed in the 
standby mode for about 10 sec beginning at 185 sec past the 
initial point. This was done by the pilot to reinitialize 
the Kalman filter prior to beginning the downwind leg of this 
segment. The pilot placed the Kalman filter in the standby 
mode again beginning at 440 sec (after flyover of the MODILS 
ground equipment). This second standby period lasted about 
40 sec, and it was entered because of large filter error 
buildup due to loss of valid MODILS data and dead-reckoning 
by the complementary filter. That is, the Kalman filter 
software was designed to only function when the complementary 
filter was functioning in its normal mode. At the end of the 
complementary filter dead-reckoning period (beginning at 
585 sec), the pilot again placed the Kalman filter in the 
standby mode to reinitialize with the valid TACAN data. Dur- 
ing the standby modes, the Kalman filter output was held 
constant to the values it had as it began these periods. 

After the third standby period was completed (at 600 sec), the 
Kalman filter began to function again by using valid TACAN 
data. 


After the MODILS data were lost at the runway crossover 
point (about 440 sec), the complementary filter began a dead- 
reckoning mode that normally lasts for a period of 120 sec. 
However, at about 40 sec into this period, it obtained some 
valid MODILS data. This caused the dead reckoning mode to 
restart. The dead reckoning mode then continued for 120 sec. 
At the end of this period, the complementary filter was re- 
initialized with the valid TACAN data. This is depicted in 
Fig. 23b. 
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Because the airborne version of the Kalman filter which 
was tested did not function during the standby mode, the 
two filter residuals can only be adequately compared during 
other periods. This is now done by taking each channel 
(x,y,z) one at a time from Figs. 23a and 23b. 

For the x,x components of the second flight segment, 
up to the first standby period, the Kalman filter had smaller 
residuals than the complementary filter. After the first 
standby period and up to when MODILS range and azimuth were 
accepted, the Kalman filter position residuals demonstrated 
transient characteristics in recovery from the standby condi- 
tion. With MODILS data, the Kalman filter position residual 
converged to a value equivalent to that of the complementary 
filter. Both filters exhibited similar recovery characteris- 
tics after the MODILS range dropout period. The Kalman filter 
velocity residual was smoother than that of the complementary 
filter up to the second standby period. 

For some reason, the Kalman filter was not initially con- 
verged for the y,y components during the second segment. 
Convergence occurred after about 20 sec (Fig. 23a). After this 
convergence, and before the first standby, the complementary 
filter had a smaller residual than the Kalman filter. Through- 
out the rest of this segment, the Kalman filter y channel was 
mostly in a transient condition reacting to the standby modes 
and data dropout. It is not clear during this remaining 
period which filter produced the smaller position residual. 
Again, the Kalman filter velocity component was smoother than 
that of the complementary filter. 

The z,z residuals shown in Fig. 23b for the complemen- 
tary filter were very small. The Kalman filter position 
residuals shown in Fig. 23a grew during the MODILS range data 
dropout. Also, the z residual was larger up to the point .of 
MODILS range dropout. The reason the Kalman filter z and z 
errors grew appreciably during the MODILS range dropout is 
that the filter was using MODILS elevation data for altitude. 
This involved using estimated values of x and y to compute 
range in the calculation of the altitude (see Eq. (A. 60)). 
Errors in x and y, therefore, induced errors in the 
altitude. The complementary filter does a similar calcula- 
tion; however, this filter uses a blending algorithm [2] to 
go from baro-altitude data to altitude derived from MODILS 
elevation data. At the time of the range dropout, the blend- 
ing had just started; thus, the altitude derived from MODILS 
elevation data had a negligible effect on the filter. The 
reason for the larger z errors in the Kalman filter, prior 
to the dropout, is not known. 
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Figures 24a and 24b show the position and velocity esti- 
mate residuals for the third flight segment . The initial 
(first 100 sec) transient x-y (position) residuals for the 
Kalman filter had a larger ^magnitude than those of the com- 
plementary filter. The x-y (velocity) residuals for the 
Kalman filter were smoother than those of the complementary 
filter. The two filters 1 z,z residuals were both quite 
small. These results are similar to those of the first flight 
segment . 

Figures 25a and 25b show the position and velocity esti- 
mate residuals for the fourth flight segment, which is similar 
to the second segment. The complementary filter was initially 
in a dead-reckoning mode, and this lasted for about 140 sec. 
Also, after landing, the complementary filter again entered a 
dead-reckoning mode which lasted about 100 sec. During these 
dead reckoning periods, the Kalman filter Was not functioning. 
Thus, the two filters should only be compared between the two 
standby/dead-reckon periods. Also, during the fourth flight 
segment, the MODILS data were not used until about 420 sec, 
even though these data were valid before this point. (The 
navaid selection was not automatic; it was selected manually 
by the pilot.) Thus, up to this point, both filters were 
using. TACAN data. 

During the fourth segment shown in Figs. 25a and 25b, 
while using TACAN data, the Kalman filter x position residu- 
al was smaller. During MODILS data usage, the Kalman filter 
x velocity residual was smoother . For the y , y components 
the complementary position residual was smaller during TACAN 
usage. Again, the Kalman filter velocity residual was smoother 
while using MODILS data. The z positi<Dn residuals for the 
two filters were both quite small. The- z residual for the 
Kalman filter was initially somewhat larger than that of the 
complementary filter. These observations are similar to those 
made from the second flight segment. 

Figures 26a and 26b show the position and velocity esti- 
mate residuals for the fifth flight segment. For practical 
purposes, the performances (error magnitudes) of the two 
filters for this segment of data were essentially equivalent. 
Again, it can be seen that the velocity residuals for the 
Kalman filter were much smoother than those of the complement- 
ary filter. 

Based on the above results, the following conclusions 
can be made : 

(1) The Kalman filter can be implemented and used for 

navigation purposes during the approach and landing 
phases of flight. 
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(2) The Kalman filter, with its three extra state vari- 
ables, did not provide any marked improvement in 
accuracy over that provided by the complementary 
filter. Thus, the TACAN data for these flights can 
be judged to be fairly accurate. That is, the 
performance of the complementary filter was not 
degraded due to the small TACAN range and bearing 
biases . 

(3) The Kalman filter provided smoother velocity residu- 
als than those obtained from the complementary fil- 
ter. The complementary filter velocity results 
could potentially be improved by changing the gains 
indicated in Fig. 8. 


Pilot Comments 

The mechanization of the Kalman filter in the STOLAND 
system flight computer was such that both Kalman and comple- 
mentary filter outputs were simultaneously available. The 
pilot could select which navigation system was in use by 
means of the STOLAND keyboard (data entry panel). The pilot 
flew the system in the fully automatic reference flight path 
mode for the flight tests so that he was able to observe and 
compare the two navigation systems without actively flying the 
aircraft . 

The general comments of the test pilot during both pre- 
flight simulation tests and the actual flight tests were that 
the Kalman filter was much better than the complementary 
filter when both systems were using the MODILS navaids. On 
both flight and simulation tests, the pilot would alternate 
between the two systems, and he repeatingly was impressed by 
the smoothness of the. flight and the displays when the Kalman 
filter was engaged. The pilot could not assess the accuracy 
of either system. He did report, however, during the final 
approach on the fifth flight segment where the Kalman filter 
was engaged, that this was one of the best localizer tracking 
performances that he had observed. A copy of the pilot flight 
report is presented as Table 3. 
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TABLE 3 


NASA - AMES RESEARCH CENTER 

FLIGHT REPORT 


“rttODEL NO. 

NO. 

DATE OF TEST 

DHC-6 . 

STOL-1 

12/10/76 

JOB ORDER 

PROJ. ENG. 

" LOT ^W 

. „ T-6110. 

D. Smith 

Hardy /Hinds on 

FLIGHT NO. 

T. O. GROSS WT/C.G. 

FLIGHT TIME 

TOE 5 

=11,300# 

=1:30 


PURPOSE 


Collect data on the Kalman filter and make a pilot evaluation of the relative performance 
between the complementary and Kalman filters. 


Tne A/C was ferried directly to NRC. One 4D RFR3 approach with the complementary filter, 

2 4D RFP5 approaches with the Kalman filter, and 2 3D RFP3 approaches switching between 
filters for pilot evaluation were made. The air was smooth and the surface winds were 
light to 5 knots. Some detailed comments: 

o The EADI went blank on the ferry portion of the flight and came back up on the 
first touch and go. 

o We lost XAV when attempting to switch between NUQ and NRC TAC's on the ferry flight. 
U : e had good signals. 

o The first approach with the complementary filter was representative of previous 

flights, is., good performance on TA£ with some S turning on short final on the MLS. 

o The 2nd and 3rd approaches with the Kalman filter and 4D flew the path but never 

slowed below 120 kts. Difficult to assess the performance from the pilots viewpoint. 

0 The 4th and 5th approaches alternating between filters and using 3D were completed 
successfully. There appeared to be little difference (from the pilots viewpoint) 
while on the TAC portion of the flight but a significant improvement in the NILS 
performance. The GS track portion or the last approach was flown on the Kalman 
filter with the only pilot input being an increase in prop RPM afc about 1000 feet. 

The performance was outstanding with the vehicle staying almost exactly in the 
center of the ILS box until manual takeover at 50 feet. The flight path acceleration 
b3r is also much more steady with the Kalman filter (as in the simulator). 

o Had some pitch up and pitch down problems after reengaging the system after the 
go- arounds . 

In summary from the pilots viewpoint the Kalman filter looks very promising. I reconrcierui 
we evaluate it in the presence of turbulence. 
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V 


POST FLIGHT ANALYSIS 


After completing the flight test analysis, some further 
investigations were conducted by using the NASA Ames CDC 7600 
computer. The Kalman filter was coded on the CDC 7600, and 
then driven with the collected flight test data. The primary 
goals of the post-flight analysis were to explain the anoma- 
lies seen in the Kalman filter flight test results and to 
develop improvements to the Kalman filter. 

The residuals that were produced by the CDC 7600 computer 
did not duplicate exactly those obtained from the airborne 
computer (1819A), This is because of differences in the 
computer characteristics, software, filter initial conditions, 
and the presence of data dropouts. However, the results were 
close enough to see the same error characteristics for each 
segment of flight as those presented in Chapter IV. 

Initial focus was placed on correcting the anomalies 
that appeared in the second flight segment shown in Fig. 23a. 
The first change that was made was to have the Kalman filter 
continue to function through all the data. No standby modes 
were entered in the CDC 7600 program. Thus, the gaps that 
appeared in the flight results for the x,y residuals (Fig. 
23a) were closed in the CDC 7600 results. Figure 27a shows 
the CDC 7600 simulation results of the Kalman filter position 
and velocity residuals for the second flight segment. These 
results are comparable to those from the airborne case shown 
in Fig. 23a. 


The MODILS range data dropout at 330 sec had a more 
severe effect in the CDC 7600 results. As can be seen in 
comparing Figs. 23a and 27a, the z position residuals are 
worse from the CDC 7600 results. Figure 27b shows the TACAN 
range and bearing bias estimates (b r »b^), baro-alt imeter Dias 

estimate (b^), and wind estimates obtained from the 

CDC 7600 simulation for this same flight segment. Note that 
the baro-alt itude bias estimates match the character of the 
residual of the z position estimate shown in Fig. 27a. Thus, 
the anomalous vertical channel behavior during the second 
flight segment can be attributed to mismodeling of the vari- 
ous error sources in the vertical channel . Upon reversion to 
use of baro-altitude data after MODILS dropout, the filter 
would develop a large altitude bias estimate which did not 
exist . 
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Further Kalman filter improvements that appeared desir- 
able included: 

(a) reduce the velocity errors when MODILS data were in 
use; 

(b) reduce the deleterious effects of the MODILS range 
dropout ; and 

(c) explain and correct the anomalous vertical channel 
behavior which occurred during climbout. 

Each of these desired improvements is now discussed. 

It was noted in the previous chapter that the velocity 
residuals appeared to be noisier when using MODILS data than 
when using TACAN data. It was revealing to compare the 
MODILS measured aircraft azimuth with that determined by the 
tracking radars. The azimuth residual" ('l / rac j ar ” ^MODILS ^ 

versus the MODILS azimuth is plotted in Fig. 28 for the five 
segments recorded. As can be seen from this plot, there is a 
marked similarity in the azimuth residuals between each seg- 
ment. This indicates that the MODILS azimuth had a definite 
angle-dependent error. This is the so-called "ripple effect" 
which is due to the electronic sweep of the azimuth beam. 

This may be the source of the above-mentioned velocity errors 
It is not known whether this error source is contant or if it 
fluctuates on a daily basis. If this error is constant, it 
could be removed by having its error characteristics stored 
in a tabular form in the airborne computer. 

The method used to reduce the effect of the azimuth 
ripple error was to incorporate a MODILS azimuth data weight- 
ing factor in the Kalman filter which is a function of azi- 
muth. That is, the assumed standard deviation of the MODILS 
azimuth noise error used in the filter was given the 

values indicated in Fig. 29. This function caused the MODILS 
data to be weighted less during the turning portions of the 
flights (where the azimuth error due to the ripple effect is 
continually changing). Consequently, the velocity estimate 
errors attributed to the ripple would be reduced because the 
MODILS data would be weighted less during the turn than when 
on the final approach. 

The effects of MODILS range dropout (item (b)) would 
best be corrected by making a hardware change in the DME 
receiver. Immediately, on the loss of signal, this change 
would produce an invalid discrete. The current system uses 
predicted range for several seconds before marking the data 
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FIGURE 28.-- MODILS AZIMUTH RESIDUALS VERSUS AZIMUTH FOR EACH FLIGHT SEGMENT. 




Absolute Azimuth Angle - | | - deg 


FIGURE 29.- MODILS AZIMUTH NOISE ERROR MODEL USED TO 
MODIFY KALMAN FILTER RESULTS 


invalid. Thus, inaccurate range information continues to be 
used until the invalid discrete is generated. 

To reduce the effect of the MODILS range dropout, a soft- 
ware change was made to the CDC 7600 simulation of the filter 
to limit the residuals processed by the filter. The logic was 
arranged so that if the residual was above this threshold 
(controlled by the estimated variance of the residual), the 
residual would be ignored (i.e., the measurement would not 
be processed). Furthermore, the accepted MODILS residual was 
limited to a second smaller threshold. The limit thresholds 
chosen for the subsequent tests were: 

Range: 300 m (100 ft) 

Azimuth: 0.009 rad (0.516 deg) 

Derived Altitude: 3 m (10 ft) 

This further limited the MODILS data spikes. 
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To modify the Kalman filter z channel results, the baro- 
altitude bias was estimated but ignored. That is, the esti- 
mated bias had no effect on the residuals used by the filter 
in the subsequent measurements. 

Figure 30a shows the second flight segment residuals 
recomputed with the above three modifications incorporated 
into the filter software. Figure 30b shows the corresponding 
wind and bias estimates. A comparison of Figs. 27a and 30a 
shows that these corrections make a significant improvement 
in the overall results. For example, the effect of the range 
dropout at 330 sec in the vertical channel is practically 
negligible. The vertical channel transients at 420 sec are 
gone. Also, the magnitude of the x,y velocity residuals 
during the turning portion of the flight (before 330 sec) are 
reduced by up to a factor of two. 

By comparing Figs. 27b and 30b, it can be seen that the 

wind estimates w and w are also reduced during the turn- 

x y 

ing period because of the filter modifications. Also, the 
TACAN bearing bias estimate becomes more nearly constant. It 
is seen that the estimated TACAN bearing bias and the wind 
components are quite small. Thus, these terms would have 
little effect on the navigation system's performance on the 
day of the flight test. 

The above filter modifications were used to reprocess 
flight data from the first, third, fourth, and fifth segments, 
in addition to the second segment. Figs. 31a-34a show the 
residuals from these segments as computed on the CDC 7600 
before the filter modifications were made. Figures 31b-34b 
show the same residuals after the modifications. By compar- 
ing these results, it can be seen that the residuals for z,z 
are consistently smaller after the modification. Also, the 
x,y residuals are consistently reduced during the turning 
portions of each segment where MODILS azimuth data were used. 

Note that in Fig. 31a, the transients in the z,z com- 
ponents that exist in Fig. 22a just before touchdown do not 
exist in the CDC 7600 results. As was mentioned earlier, the 
cause of the transient shown in Fig. 22a was never isolated. 

Another test was made where the baro-alt itude bias and 
the TACAN biases (range and bearing) were removed from the 
filter. The reason for this change is that TACAN bearing 
bias is unobservable before the MODILS data are used. This 
change was tested on the second segment of flight data, and 
the results are shown in Fig. 35. This figure is compared 
with the results shown in Fig. 30a. These changes affect the 
performance produced where TACAN data is used from 100 sec 
to 280 sec and from 450 sec to the end of the segment . 

Dropping the TACAN biases appears to decrease the x,y resid- 
uals from 100-280 sec. Also, the x residual is improved 
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FIGURE 30b,- RECOMPUTED SECOND SEGMENT BIAS AND WIND 
ESTIMATES WITH MODIFIED FILTER AND 
BARO-ALTIMETER BIAS REMOVED . 
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FIGURE 34.- FIFTH FLIGHT SEGMENT KALMAN FILTER RESIDUALS 

COMPUTED ON CDC 7600. 






from 450 sec on. The y residual appears to be slightly 
worse than that shown in Fig. 30a. It is concluded that for 
the data collected during this flight test, the TACAN bias 
estimates do not provide significant improvement in per- 
formance. That is, v the TACAN data appeared to be essentially 
free of bias errors. However, if large TACAN range and bear- 
ing biases were actually present, their estimation would 
have improved the overall results. 

In summary, it is concluded that the following software/ 
hardware modifications would significantly improve the Kalman 
navigation filter tested in the STOLAND system: 

(1) Compensate for the ripple effect in the MODILS 
azimuth signal. The post-flight analysis demon- 
strated that weighting the azimuth data as a func- 
tion of the azimuth improved the performance. A 
better approach would be to make hardware modifica- 
tions to remove (or reduce) the ripple effect from 
the MODILS azimuth signal. 

(2) Improve the error model for the vertical channel. 

The post-flight analysis showed that by ignoring 
the baro-altimeter bias estimate obtained from the 
Kalman filter, one could remove the anomalous 
vertical channel errors following revision from 
radar altimeter data to barometric altimeter data. 

(3) Compensate for the effects of dropout in the MODILS 
DME data. The post-flight analysis showed that 

by limiting the MODILS residuals, one could reduce 
the effects of the dropout. A better approach 
would be to modify the DME receiver so that the 
hardware flag shows invalid data immediately on 
loss of signal in the DME receiver. 

(4) Change the on board software such that the standby 
mode does not disengage the Kalman filter. Further- 
more, the Kalman filter initialization and operation 
should not be influenced by the complementary filter 
modes. The Kalman filter software which was tested 
was designed so that both the Kalman and complemen- 
tary filters would use the same navaid information. 
The Kalman filter operation was controlled to some 
extent by the complementary filter in an attempt to 
get good comparative information. The design did 
not accomplish this purpose; furthermore, it caused 
serious degradations in the Kalman filter perfor- 
mance in certain regions of the flight. 


86 



The above factors (and others) can also enhance the per- 
formance of the complementary filter. Reference 13 describes 
the results of a parallel investigation of complementary 
filter modifications for achieving improved navigation per- 
formance . 
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CONCLUSIONS AND RECOMMENDATIONS 


This study involved the implementation of an experimental 
Kalman filter based navigation system in the STOLAND avionics 
computer (Sperry 1819A). This implementation was then tested 
aboard the NASA Ames Twin Otter aircraft. The aircraft posi- 
tion and velocity, as derived by the Kalman filter, were 
measured in the flight test which consisted of five approach, 
landing, and climbout profiles. The position and velocity 
were also simultaneously computed by the regular STOLAND 
navigation software. The results of the Kalman filter and 
the STOLAND system (complementary filters) derived state 
variables were then compared. Post-flight simulation studies 
were also conducted to determine improvements to the Kalman 
filter configuration . 

As a result of these studies, the following conclusions 
can be made : 

(1) It was shown that it is feasible to use a Kalman 
filter in its full form during the landing phase 
of flight for navigation computations. The state 
accuracy provided is equal to or better than that 
provided by the more conventional complementary 
filter used in the STOLAND system. 

(2) The Kalman filter used in this study provided 
smoother velocity estimates than that of the com- 
plementary filter. This is advantageous for dis- 
play purposes. The test pilot referred to the 
Kalman filter performance as "outstanding" in the 
ability to keep the aircraft on the desired approach 
beam. The errors in the horizontal position deter- 
mined by both filters (Kalman and complementary) 
were about equivalent for the flight profiles 
flown. The potential improved accuracy of the Kal- 
man filter during usage of TACAN data when large 
bias errors in range and bearing could be present 
was not demonstrated in the flight tests because 
they were conducted on a day when the TACAN biases 
were small. 

(3) The Kalman filter implementation for the tests 
required about three (3) times the memory and 
about one and one-half (1.5) times the computer 
time as that of the complementary filter used 



in the comparison. The actual memory requirements 
for the Kalman filter were about 3000 words, and 
the time requirements were about 18% of the 1819A 
computer cycle time of 50 msec. Neither of these 
requirements is very large when considering modern 
computer technology. 

(4) In future flight tests, improved performance from 
the Kalman filter could be achieved by eliminating 
or limiting the barometric altimeter bias error 
estimate, and by limiting the MODILS derived range, 
azimuth, and elevation residual magnitudes. Thus, 
the improved Kalman filter would estimate three 
components of position, velocity, and acceleration 
bias, TACAN range and bearing bias, and the two 
components of the horizontal wind (thirteen state 
variables). It was practical to keep the vertical 
channel (z filter) essentially decoupled from the 
horizontal plane (x-y filter). 

The results of this study are being extended at NASA 
Ames to other aircraft such as the UH-1. They will be useful 
to future integrated navigation, guidance, and flight control 
investigations . 

Because of the good results from these terminal area 
studies, it appears possible to use the Kalman filter naviga- 
tion equations for the entire flight profile consisting of 
take-off, climbout, cruise, approach, and landing. This 
would allow using data from multiple VOR/VOR or DME/DME com- 
binations in addition to the VOR/DME (TACAN) used in this 
study. Then, the Kalman filter should provide greater 
improvements over the complementary filter. The reference 
frames necessary for such an implementation may be different, 
such as those defined in Ref. 14. It is recommended that 
such a universal implementation of an aided inertial naviga- 
tion system employing the Kalman filter be developed and 
flight tested in the future. 
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APPENDIX A 


KALMAN FILTER FORMULATION 


This appendix first summarizes the basic Kalman filter 
equations and the filter design used in the STOLAND Flight 
Test System. Then, the specific navigation equations used to 
keep the estimate of the state current and the error equations 
used to update the filter results in time are summarized. 

Next, the equations used in the filter to process the external 
measurements are developed. Finally, measurement preproces- 
sing, interface with the regular STOLAND navigation system, 
and filter initialization are discussed. 


Basic Kalman Filter Principles 

The error state dx is defined as the continuous error 
in the estimate X of the aircraft’s true state vector X. 
That is, 


dx = X - X 


( A . 1 ) 


The aircraft navigation error state considered in this study 
had fourteen variables (elements) which are: 


3 

3 

3 

2 

1 

1 

1 


element position error vector with respect to the 
runway , 

element velocity error vector with respect to the 
runway, 

element acceleration bias vector, 
element error in horizontal wind vector, 
element TACAN range bias, 
element TACAN bearing bias, 
element baro-altimeter bias. 


For mechanization convenience, these variables were separated 
into a group of ten associated with the aircraft horizontal 
position (x-y filter) and a group of four associated with 
the aircraft vertical position (z filter). This decoupling 
is explained more fully later. The following development 
initially ignores the decoupling. 
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The fourteen elements of dx are assumed to be small so 
that the dynamics which describe their time rate of change 
can be modeled by the linear matrix differential equation. 


Here, 


dx = F dx + F q . (A. 2) 

x q 

dx = the n (14) element error state vector, 

F x = an n x n system dynamics matrix, 

F = an nxm error distribution matrix, 

q = a vector of m random forcing functions for 

compensation of error growth caused by un- 
modeled error sources. 


The objective of the Kalman filter is to estimate the 
error state dx so that: (a) the true aircraft state can be 

more accurately known, and (b) the effects of the various 
sensor biases and wind can be removed by compensation. The 
filter estimate of the error state is defined as dx. The 
functions of the Kalman filter algorithm are to: (a) carry 

the error state estimate dx along in time, and (b) to up- 
date (or increment) dx based on external measurement infor- 
mation. Then, on a regular basis, the error^estimate dx 
is used to correct the total state estimate X. 


Because Eq. (A. 2) represents a linear system, the error 
state dx can be advanced from time point to time point by 
use of the state transition matrix. The approximate solution 
to Eq. (A. 2) for dx at time point t^ + ^, given dx(t k ), is 


Here , 


dx<t k+i ) ■ 


“"‘WV 


dx(t k ) 


vw 


V 


u(t k ) 


(A. 3) 


= the state transition matrix. 


<I> = the forcing function sensitivity matrix, 


U( V 


a constant (in the interval 


t k to 


'k+l 


) 


vector for approximating the effects of the 
random vector, q, of Eq . (A. 2). 
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The Kalman filter utilized in this study was designed to 
minimize effects caused by: (a) numerical calculation errors 

such as truncation, and (b) modeling errors resulting from 
various approximations. Past experience has shown that the 
square root implementation [10] of the Kalman filter algorithm 
can reduce the effects of the numerical errors to insignifi- 
cant levels. The square root implementation was therefore 
incorporated into the design used in this study. Modeling 
errors were compensated by the appropriate use of random forc- 
ing functions. This technique causes the more recent measure- 
ments to be weighted more than past measurements; therefore, 
the estimate tends to follow the more recent measurements. 

An essential part of the Kalman filter is the covariance 
matrix P(t k > of the error state dx at each time point t fe . 

This matrix is given by 


P(t k ) = W(t k ) W T (t k ) = E{dx(t k )dx T (t k )} . (A. 4) 

where 

W(t k > = the square root of the covariance P(t k ) 

(W T is calculated in the square root 
implementation of the filter). 

E{ } = the expected value operator. 

It is assumed that u(t k ) of Eq. (A. 3) is a random indepen- 
dent vector such that 


E{u(tk + i)u T (tk + g )) = 0 


i f l 


= U(t k+i ) uT (tk + i) • i - * (A- 5) 


It is necessary to update the covariance matrix 
consecutive time point t^ to the next t^ +1 - 

ate use of the expected value operator with Eq. 
the time update of the covariance matrix as. 


P from one 
The appropri- 

( A . 3 ) gives 


P(t k+ i) -»< W w ‘W = 


w T (t k )<& T 




(A. 6) 
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I I III 


ii mi 


I II I 


T 

From Eq. (A. 6), it is seen that one can form W (t, - ) as 

follows: 


» <W - 






(A. 7) 


T 

The matrix, W (t^ + ^) of Eq. (A. 7) has dimension 

(n+m)xn. The Householder algorithm described in Ref. 10 is 
used in the filter mechanization to reduce this matrix to an 
upper triangular form. That is, all the terms below the 
diagonal are zero in the reduced matrix. The matrix reduc- 

T 

tion algorithm leaves the product WW invariant. 

A discrete measurement residual y is defined as the 

m 

difference between the external state measurements Y m (X,t) 

of the aircraft (from available navaids, air data sensors, 
etc,) and the computed value Y(X,t m ) of the measurements 

based on the continuously available navigation equation state 
estimate X. Explicit definitions of the navigation equations 
and computed measurement equations are given in the next sec- 
tion. It is assumed that the measurement residual is related 
to the error state dx at the time point t when the 
measurement is made by the equation m 


y (t ) = Y (X,t ) - Y( X , t ), 
m m 5 m' v ’ m ’ 


= Hdx(t m ) + q . (A. 8) 

Here , 

H - external measurement distribution (sensitiv- 
ity) matrix, and 

q = the random noise error in the external 
measurement . 

For an individual measurement, H is a row vector. The Kal- 
man filter is based upon the structure of Eqs. (A. 2) and 
(A. 8) and the assumed Gaussian statistical properties that 
describe the vectors r| and q. 
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Similar to Eq. (A. 8), the estimated measurement residual 

at time point t is assumed to be, 
m 

y m (t ) - Hdx(t ) . (A. 9) 

m m m 

Here, 

y (t ) = the computed value of the position meas- 

m m urement residual based on the error state 

estimate dx(t ). 

m 

External measurements can be taken rapidly at arbitrary 
time points t m - For the terminal area navigation system of 

this study, it is computationally inefficient to advance the 

T 

square root covariance W of Eq. (A. 7) to each arbitrary 
time point t m to process each measurement. Thus, the Kalman 

filter is mechanized to operate with cyclic reference times 

t. , t, , t._, 0 , etc. Then all external measurements taken 
k k+1 k+2 

between t^ and t^ + ^ are usec * to adjust the estimate dx 
at the time point t^. For the system mechanized in this 
study, (t k+1 ~t k ) was set at 1.5 sec. 

The error in the estimated residual y (t ) can be found 

m m 

from Eqs. (A. 3), (A. 8), and (A. 9) to be approximately 

Ay(t ) = y (t ) - y (t ) , 

m °m m nr 

= y (t ) - HO(t ; t. ) dx( t. ) . (A. 10) 

^m nr v m k v k y 

This neglects the effects of the driving term r\ , in Eq. 

(A. 2). Experience has shown that this simplification is 
justified when the update interval is sma11 com- 

pared to the natural frequencies of error growth in the navi- 
gation equations. 

To update the estimated error state dx(t fc ) from each 

of the measurement residuals Ay(t ), the following computa- 
tions are typically made. Let m 
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(A. 11) 


H «W • 

W(t k )W T <t k )HT/( V (t k )W T (t k )HT + q, . 

Here, Q is the assumed variance of the random error q in 
the measurement , 

Q = E(q 2 ) . , (A. 12) 

Then, the new estimate of the error state following inclusion 
of the measurement would be, 

dx ( t k ) a = d ^( t k ) b + KAYCV • (A. 13) 


H = 
m 


K = 
m 


Here, the subscript notation ( ) and ( means before and 
after inclusion of the measurement, respectively. 

T 

The square root covariance matrix W (t^), after inclu- 
sion of the measurement, would be updated by, 

W T(t k ) a = wT ( t k ) b ’ BcT / D > (A. 14) 


where 


B 

C 

D 


W T (t ) h t 
” K k J bw 


"<Vb B , 

(B T B + Q) (1 + 7q/(B T B + Q)] 


Equation (A. 14) is referred to as Potter T s algorithm (see 
Ref. 10). 

In order to reduce the number of operations in the air- 
borne computer further, the residuals of each external meas- 
urement were accumulated (and effectively averaged) over the 
1.5 sec period rather than individually processed. That is, 
instead of using Eqs. (A. 10)-(A. 14) everytime a new measure- 
ment is taken, the residuals of a particular measurement 
variable (e.g., TACAN range) are accumulated over the 1.5 sec 
period according to 
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y (t m ) = Y - Y(X,t m ) 

(A. 15a) 

y = y + Ay ( t ) 
J s J s J K m 

(A. 15b) 


Note that the residual in^Eq. (A. 15a) is based on the esti- 
mated total measurement Y from Eq.^(A.8). This estimate is 
based on the estimated total state X at time t which 
comes from the navigation equations. m 

The measurement sensitivity matrix H m of Eq. (A. 11) is 

computed and accumulated simultaneously with the residual 
accumulation. That is, 


H (t ) = Hd>(t ; t. ) , 
m m m’ k' ’ 


H = H + H ( t ) , 
ms ms mm* 


(A. 16a) 
(A. 16b) 


are used to accumulate H over the 1.5 sec period. Fur- 

m 

thermore, the variance Q of Eqs. (A. 11) and (A. 12) is 
replaced with the assumed variance Q g of the random noise 

error in the accumulated residual. More mechanization details 
are given on the residual sum processing later. 

Now define the variance in the accumulated residual of 
an individual measurement as 


S 


I W'< t k» ,T < t k )H ms + « s 


(A. 17) 


Then, after the last external measurement has been taken and 

y , H , Q and S have been computed during the 1.5 sec 
s ins s 

period, the estimated error state dx(t,) is updated accord- 
ing to 


dx(t k ) a = dx(t k ) b + WW T H^ s [y s -H ms dx(t k ) b ]/S . 

(A. 18) 

As can be seen, Eq . (A. 18) is a variation of Eqs. (A. 11) and 
(A. 13). 
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Also, for each accumulated measurement, the square root 
covariance is updated according to 

W T = W T - W T H T H WW T /[S(1 + VQ /S)] . (A. 19) 

ms ms 7 ^s J 

Equation (A. 19) is a variation of Eq . (A. 14). 

Equations (A. 18) and (A. 19) are repeated for each of the 
different measurements in effect (e.g., TACAN range and 
bearing, air data, and baro-alt itude ) . This produces an up- 
dated error state estimate dx(t^) , at time point t^. This 

estimate is then advanced to the time point t^ + - according 
to 

dx(t k+ i) = d x(t k ) . (A. 20) 

The estimated total state is then updated by 

' ; 'Wb + di(t k + l> ' <A - 21) 

A 

where x ( t k+l^b is value obtained from the navigation 

equations. After completion of Eqs. (A. 21), dx(t^ + ^) is 

set to zero, the square root covariance is advanced to t^ + ^ 

according to Eqs. (A. 7), and the process is repeated for the 
next cycle. 

In summary, the mechanized filter was designed to oper- 
ate along a time line illustrated in the sketch below: 


I 1 1 1 1 L^AJ I I I 

t l t 2 t 3 t 4 t 5 * t 12 t 13 *14 t k+l 


Each of the time points t^, t^, etc. are 0.1 sec apart. The 

major time interval between points t^ and t^ + i is 1-5 sec. 

At the start of the sequence, the filter has its covariance 
matrix P referenced to time point t^. At the time points 
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t k> t^, . . . , ^ 14 ? external measurements are accepted by the fil- 
ter, and measurement residuals and partials are computed, 
accumulated, and saved in the preprocessing routines. After 
the filter processes the measurements at the time point t^, 

the residual sums and partials are used for updating the in- 
cremental state estimate at t fc . Then, the locations used for 

the preprocessing are cleared for use in preprocessing the 
external measurements at t^ + ^ and the subsequent time 
points. 

The residual sums are processed by the filter, and the 
incremental state change is computed . When these calculations 
have been completed, the estimated state change is advanced 
and added to the total state at the time point t^ + ^. Mean- 
while, other computations update the covariance matrix to the 
time point t k+1 , and the logic sets up the filter for pro- 
cessing the residual sums taken during the next major time 
interval. The on board program operations for executing this 
logic in the Sperry 1819A computer are described in Appendix 
B. 


Navigation and Error Equations 

The three-axis Kalman filter used in the Ames STOLAND 
Flight Test System is depicted in Fig. 10. The vertical 
elements of the estimated state (z-filter) discussed in Ref. 

6, remain decoupled from the horizontal elements (x-y filter) 
discussed in Ref. 5. Attitude and heading data and three 
body-mounted accelerometers are used to transfer the accelera- 
tion measurements into the runway reference frame. Existing 
STOLAND 1819A software performs this transformation at a 20 Hz 
frequency. 

The navigation equations used to keep the state estimate 
current integrate the terms 


/*v 


a = 

X 

+ 

b 

sx 

r 


ax 

a " 

y 

+ 

b 

sy 

J r 


ay 

A 

a = 

z 

+ 

b 

sz 

r 


az 


(A. 22) 
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where 


x , y r> z r =| raw acceleration in the runway refer- 
ence frame as computed by existing 
STOLAND software. 

AAA 

b ,b ,b = estimates of the acceleration measure- 
ax ay az ment biases 

These terms are numerically integrated by the equations 


• • 

dx i (t+At f ) = dx i (t) + a sj At f 

• • 

dx i (t+At^) = dx i ( t ) + [dx^^C t+At ^)+dx^( t ) ] At j/2 . 


(A. 23) 

Here, the subscripts i refer to the three (x, y, and z) com- 
ponents of runway referenced, estimated change in position 

(dx. ) and velocity (dx. ) due to acceleration (a .). Equations 

(A. 23) are approximations which are valid for a "flat" non- 
rotating earth. The errors resulting from this approximation 
are negligible in comparison to the errors caused by inertial 
hardware components (that is, the errors in the attitude and 
heading references and the errors in the body-mounted accel- 
erometers). In the on board program, the raw acceleration 
data is accepted and integrated at 20 Hz (i.e., At f is 
0.05 sec). 

The vector form of the error equations is given in Eq. 

(A. 2) where the fourteen element error state vector, dx, is 
as defined previously. In the subsequent summary, it is 
assumed that elements of the noise vector u(t^) are all 

independent variables with unit variance. The actual magni- 
tudes associated with the noise are included as constants of 
the $ matrix of Eq. (A. 4). 

The transition matrix, O, is approximated as 


O = I + A . (A. 24) 

Here, I is the identity matrix, and A is a sparse matrix 
which represents the matrix F in discrete form. It is now 

defined for the x-y portions of the filter. 
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The x-y portion of the filter has ten elements which 
include: 

dx(l) = position error component along runway (dx), 

dx(2) = position error component normal to runway 

(dy), 

dx(3) = velocity error component along runway 

(v x = dx), 

dx(4) = velocity error component normal to runway 

(V y = dy), 

dx(5) = acceleration bias component along runway 


dx(6) = acceleration bias component normal to run- 

way (b ay } ’ 

dx(7) = TACAN range measurement bias (b^), 

dx(8) = TACAN bearing measurement bias (b^), 

dx(9) = wind error component along runway (w^), 

dx(10) = wind error component normal to runway (w^). 

In the subsequent discussion, for convenience, the de- 
tails of the x-y portion of the filter are separated from the 
z portion by subscripts "x" and n z". For the horizontal x-y 
portion of the filter, the non-zero elements of A in Eq. 

(A. 24) are given by 


x (1 ' 3 > 

= A x (2,4) = 

A x (3,5) = A x (4,6) = At 

x a,5) 

= A x (2,6) = 

At 2 /2 , 


= A x (6,6) = 

At/t a , 

* <7 ' 7 > 

= - At/t r 

y 

X 

00 

00 

w 

= ~ At/i + 

y 

x< 9 ’ 9 > 

= A x (10,10) 

= - At/r w . 
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Here , 


At = period over which the transition matrix is 
used, 

z = time constant for acceleration colored noise 
a (100 sec), 

t = time constant for TACAN range colored noise 
r (1000 sec), 

t . = time constant for TACAN bearing colored noise 
v (1000 sec), 

t = time constant for wind error colored noise 
w (100 sec). 

Nominal values used for the time constants are shown in paren- 
theses. 

The nonzero elements of the forcing matrix O (from 
Eq . ( A . 4 ) ) are given as ux 


Here , 


o 

(3,3) 

= <D (4,4) = 

a At , 

ux 


ux' ’ ' 

v ’ 

O 

ux 

(5,5) 

= <D (6,6) = 
ux 

a a V2At/T a 

O 

ux 

(7,7) 

= 4> V2At / i 
r r 

y 

O 

ux 

(8,8) 

- V 2it/ '+ 

’ 

O 

ux 

(9,9) 

- ®ux <10 ' 10) 

= 4> w V2At/ 


At = period of the major time update (1.5 sec), 

o = standard deviation (std) of velocity noise 
v (0.0762 m/s), 

o 

a = std of acceleration colored noise (0.1524 m/s ), 
a 

o r = std of TACAN range colored noise (304.8 m) , 
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n 


l 

J 


I 


a . = std of 

♦ 

a = std of 
w 

The z filter has 


TACAN bearing colored noise (2 deg), 
wind colored noise (6.1 m/s). 

a four element error state comprised of 


dx( 1 ) 
dx( 2 ) 
dx( 3) 

dx( 4 ) 


vertical position component error (dz), 

vertical velocity component error (v = dz), 

z 

vertical acceleration bias component error 
(b az>. 

bias error in barometric altitude (b^). 


The non-zero elements of A in Eq. (A. 24) for the z por- 

z 

tion of the filter are as follows: 


A z (l,2) = At , 
A z (l,3) - At 2 /2 , 

A z (2,3) = At , 
A z (3,3) = - At/i a 
A z ( 4,4) = - Ab/ T h 


(A. 27) 


Here , 


time constant for barometric altimeter colored 
noise (1000 sec). 


The non-zero elements of the forcing matrix (O^ of Eq . 
(A. 3)) for the z-portion of the filter are given by 


% z ( 3 ' 3 ) = °a«r , 

°uz (4 ’ 4) = * 


(A. 28) 
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Here, 


a = std of barometric altimeter bias colored noise 
n (60.96 m). 

Again, the nominal value for the standard deviation is given 
in parentheses. 


External Measurement Processing Equations 

To^relate the external measurements to the estimated 
state X, mathematical models of the measurements are requir- 
ed in terms of the elements of X. The models are required 
for : 

(1) defining the computed measurement as a function of 
the estimated state (i.e., Y(X,t ) used in Eq. 

(A. 15a), m 

(2) defining the partial row vector which relates the 
residual to the error state (i.e., H of Eqs. 

(A. 8) and (A. 16a)), and 

(3) defining the variance of the random error in the 
measurement (i.e., Q of (A. 17)). 

The models used in the on board program are developed in 
this section for TACAN, MODILS , airspeed, and altitude 
measurements . 

TACAN . - TACAN measurements consist of: (a) the range 
from the aircraft to the station, and (b) the bearing (with 
respect to magnetic north) of the station with respect to the 
aircraft. The range measurement is modeled as 

Y tr = %/(x-x T ) 2 + (y-y T ) 2 + (z-z T ) 2 + t> r + <l tr • (A. 29) 

Here , 

x, y, z = the coordinates of the aircraft with 

respect to the runway reference frame, 

x„,y T ,z T = the coordinates of the TACAN station 
with respect to the runway reference 
frame , 

b = the bias error in the range measurement, 

r and 
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q. = the random noise error in the range 

measurement. 

The estimated measurement is computed from 

Y tr = 7(x-x t ) 2 + (y-y T ) 2 + (z-z T ) 2 + b r , (A. 30) 

where x, y, and b r are state variables obtained from the 
x-y filter, and z is obtained from the z filter. 

The non-zero elements of the row vector H of Eq. 

(A. 8) are calculated from 


■W 1 * 


■W 2 > 


>W 7 > 


(S-x T )/(Y tr -b r ) , 
(y-y T )/(Y tr -b r ) , 
l. 


(A. 31) 


The variance Q, 
tr 

TACAN range measurement 


of the random noise error in the 
is assumed to be a constant given by 


Q tr = (92 m) 2 . 


(A. 32) 


The bearing measurement is modeled as 


Here, 


tb 



vl/ + b, 
Y r vj/ 


+ q 


tb 


(A. 33) 


\)/ = the azimuth of the runway with respect to 

r magnetic north, 

b. = the bias error in the bearing measurement, 

* and 

q . = the random noise error in the bearing meas- 

urement. 


105 


The estimated measurement is computed from 



tan 


-1 


(y T -y) 

(x T -x) 


+ v|/ + b . , 

Y r \|/ ’ 


(A. 34) 


where x, y, and are state variables of the x-y filter. 

The non-zero elements of the row vector H for the bear- 
ing measurement are calculated from 


H tbx 

H tbx 

H tbx 


( 1 ) 

( 2 ) 

( 8 ) 


(y T -y)/ [(x-x T ) 2 + 

(x-x T )/ [(x-x T ) 2 + 


l. 


(y-y T ) 2 ] 

(y-y T ) 2 ] 


(A. 35) 


The variance Q, , of the random noise error in the 
to 

TACAN bearing measurement is assumed to be a constant given by 


«tb -d. deg) 2 


(A. 36) 


MODILS range and azimuth .- The MODILS measurements used 
in the x-y portion of the Kalman filter are range and azimuth 
from a co-located DME transponder and azimuth scanner. The 
range measurement is modeled as 

Y = 7(x-x ) 2 + (y-y ) 2 + (z-z ) 2 + q . (A. 37) 

mr v m J m 4 mr 

Here , 

x ,y ,z = coordinates of the MODILS transponder 
m m m and scanner with respect to the runway 
reference frame, 

q = the random noise error in the range 

-mr 

measurement . 
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The estimated measurement is computed from 


mr 


= /(x- 


x + (y-y + (z-z )^ 
nr w ^m v m 


(A. 38) 


Here, x and^ y are state variables obtained from the x-y 
filter, and z is obtained from the z filter. 

The non-zero elements of the row vector H for the 
range measurement are calculated from 


W 1 ’ - ( *-V/ Y mr • 


H( 2 ) = (y-y )/Y 
mrx m mr 


(A. 39) 


The variance of the random noise error in the range 
measurement is assumed to be a constant given by 


Q mr = (18.3 m; . 


(A. 40) 


The MODILS azimuth measurement is modeled as 

= tan -1 [ ( y-y m )/'/( x-x m > 2 + (z-z m ) 2 ]+ q mQ . (A. 41) 


ma 


m 


m 


a ma 


Here, q is a random error in the azimuth measurement. 

’ ^ma 

The estimated measurement is computed from 

*ma = tan" 1 [(y-y m )/y(x-x n) ) 2 + (S-z^ 2 ]• (A. 42) 


Again, x and y are state variables of the x-y filter, and 
z is obtained from the z filter. 


The non-zero elements of the row vector H for the 
azimuth measurement are given by 

H max (1) = (y-y m )(x-x m )/(r 1 (r) 2 ) , 

9 (A. 43) 

H (2) = r 1 /r . 
max v ' 1' 
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are defined as 


Here, r and 

r = >/(x-x m ) 2 + (y-y m ) 2 + (z-z m ) 2 , 

(A. 44) 

r 1 = '/(x-x ) 2 + (z-z ) 2 . 

1 m m 

The variance of the random error in the measurement is 
assumed to be a constant given by 


<3 = (0.1 deg)‘ 


'ma 


(A. 45) 


True airspeed .- The existing STOLAND software computes 
the level components of true airspeed in the runway reference 
frame from air data and altitude data. These components are 
assumed to be direct measurements in the Kalman filter's x-y 
frame rather than using the more complex mechanization in- 
volving actual raw data sensors. 

The x and y component air data measurements of true 
airspeed are modeled as 


Here, 


Y = v - w + q 
ax x x n ax 


Y = v - w + q 
ay y y ay 


(A. 46) 


v , v = ground velocity components along and nor- 
x ^ mal to the runway, 


w , w = wind velocity components along and nor- 


x’ y 


mal to the runway, 


q ,q = the random noise errors in the air data 
ax ay measurements. 


The estimated measurements are computed from 


A A A 



(A. 47) 


A A A 
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where v , v , w , and w are state variables of the filter, 
x y x y 

The non-zero elements of the row vector H for along 
the runway are given by 


H (3) = 1 , 
axx ' 


H (9) = -1. 
axx v 


(A. 48a) 


The non-zero elements of the row vector H for normal 
to the runway are given by 


H (4) = 1. 
ayx v 


H (10) = -1. 
ayx 


(A - 48b) 


The variances of the random noise error in the air data 
measurements are assumed to be constants given by 


Q ax = Q ay = (0 ' 61 m / s) ‘ 


(A. 49) 

Barometric altimeter.- The barometric altimeter meas- 


urement is modeled as 


Here, 


Y u = -z + h + b + q, 
h r n M h 


(A. 50) 


z = vertical position of the aircraft with respect 
to the runway reference, 

h r = runway altitude with respect to sea level, 

b. = bias error in the barometric altitude meas- 
urement , 

q = random noise error in the barometric altitude 
measurement . 

The estimated measurement is computed from 


Y = -z + h + b, 
h r h 


(A. 51) 
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where z and are state variables of the z portion of the 

filter. The non-zero elements of the row vector H are given 
by 


(A. 52) 

H hz< 4 > = 

The variance of the random noise error in the measurement 
is assumed to be a constant given by 

Q h = (1.2 m) 2 . (A. 53) 


Radio altimeter .- The radio altimeter measurement is 
modeled as 


Y r = -z + q r , (A. 54) 

where q r is random noise error in the radio altimeter meas- 
urement. The estimated measurement is computed from 

Y = -Z . (A. 55) 

r 

The non-zero element of the row vector H is 

H (1) = -1 . (A. 56) 

rz 

The variance of the random noise error in the measure- 
ment is assumed to be a constant given by 

Q r = (0.6 m) 2 . (A. 57) 

MODILS elevation .- Define the aircraft relative posi- 
tion coordinates with respect to the MODILS elevation antenna 
as 
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X 


x e = X - X E 


y e = y - y E 


(A. 58) 


5 e = 2 - Z E 


Here, ( ) are the location components of the MODILS 

elevation antenna with respect to the runway reference frame. 
Also, define the auxiliary quantities 


z- = z cos (5°) - x sin (5°) , 

1 e e ’ 


x- = x cos (5°) + z sin (5°) , 


(A. 59) 


- JJT+ 


1 • y e 


The altitude measurement calculated from the MODILS elevation 
measurement is expressed as 


= [-x e sin (5°) + r^ tan(s-5°)] / cos ( 5° ) + q g . 

(A. 60) 


In Eq. (A. 60) , 

e = the elevation measurement above the horizontal 
plane , 

q = the random noise error in the pseudo-altitude 
e measurement . 

Equation (A. 60) requires the values of x , y , and z , which 

e e e 

are not available; instead, estimates of these states are used 
in the calculation. 

The estimated measurement is given by 


A 



A 


-z 


(A. 61) 
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The non-zero element of the row vector H is given by 


H 0Z (1) = -1 • (A. 62) 

The variance of the random noise error in the measurement is 
assumed to be a range dependent quantity 

Q e = (0.002 t ± ) 1 2 3 , (A. 63) 

where r^ of Eq. (A. 59) is in meters. 


Measurement Preprocessing and Rejection 


The mechanized filter contains routines for calculating 
the residuals and partials (H vector) as just discussed, and 
for summing the results appropriately at a 10 Hz frequency. 
Each residual sum and its partial are transferred to appropri- 
ate arrays for processing by the Kalman filter algorithm at 
the basic 0.667 Hz frequency. 


The preprocessing routines contain logic for executing 
the following steps in a sequential manner for each measure- 
ment : 


(1) Test the hardware validity flags. If the measure- 
ment is invalid, the subsequent steps are bypassed. 
This step is omitted for the airspeed and baromet- 
ric altitude measurements because they do not have 
hardware validity flags. 

(2) Compute the residual by Ay i = (measurement 

minus computed measurement). 

(3) Test the reasonableness of the residual. If the 
residual magnitude exceeds a precomputed tolerance 
level, the subsequent steps are bypassed. 


(4) 

(5) 


Accumulate the residual into the residual sum by 


si 


■ y si +A yi 


Calculate the H vector for the measurement., and 

reference the vector to time by 


H mi<V 


H ± (t) 0(t;t k ). 
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into the partial sum by 


(6) Accumulate elements of H 

H msi = H msi + H mi- 

(7) Increment a measurement counter by unity. (The 
number of valid measurements in each sum is calcu- 
lated. ) 

The TACAN bearing and MODILS azimuth measurements have 
additional logic before Step (2) which rejects the measurements 
if the ground distance from the station (or scanner) to the 
aircraft is less than 305 meters. 

Following completion of the above logic for each of the 
measurements (every 0.1 sec), a marker is tested to determine 
if the basic 1.5 sec basic cycle is complete. If this test 
is passed, the incremental state changes are calculated, as 
is described earlier. 

The variance of the random error in each residual sum 
is calculated from 

Q 1 = Qxx (n x )1<4 (A. 64) 


where 

Q 1 = the variance for an individual measurement, 
n^ = the number of residuals in the sum. 

The number 1.4 is used to account for the fact that the ran- 
dom error q in each measurement has some correlation from 
time point to time point. 

In addition to the validity flags and residual reason- 
ableness tests, a test is made on the reasonableness of the 
residual sum before it is used to calculate an incremental 
state change. The Potter algorithm (see Eq. (A. 14)) requires 
calculation of the quantity 

(G m ) 2 = B T B + Q (A. 65) 

for each residual sum. Let 

y = the residual sum for the particular standard 

sm deviation a involved. 

m 
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Then the mechanized filter rejects the measurement if 


c y 


sm‘ 


> a 


m 


(A. 66) 


The value of c used in this study was 0.25. The value of 

a for each measurement is used in the reasonableness test 
m 

prior to summing the residual (Step (3) above). 


Interface With STOLAND 

The estimated error state is obtained from the x-y and 
z filters every 1.5 sec. When the error state is added to 
the state estimate, discrete jumps occur which, as a result of 
the low frequency, may be objectionable to the pilot or auto- 
matic control system. In order to. prevent discrete changes 
from occurring in the state estimate used by the STOLAND sys- 
tem, smoothing logic was defined as depicted in Fig. 10. This 
logic is explained here. Let 


x r 

= estimated 

position 

vector, 

A 

v r 

= estimated 

velocity 

vector , 

c 

X 

= position 

smoothing 

vector, 

c v 

= velocity 

smoothing 

vector . 


Assume that errors dx and dv have been estimated 

r r 

(from the filters) to be added to x r and v , respectively. 

Then at the time of introduction (time point t^ + p , the fol- 
lowing equations are executed: T 


( Va 


( x r )b + dx r 


( Va 


. A v , A 

(v r>b + dv r 


< c x>a 


(c x>b - dx r 


«Va 


(c v>b - dv r 


(A. 67) 
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are decremented in 


Then, at a 20 Hz frequency, c and c 
accordance with x v 


c x (t +At f) = ac x ( t ) » 


c v (t+At f ) = P c v ( t ) . 


Here, a and p are constants computed from 


- . 05/ i 

a = e 1 x 


p - e“ * °®/ T v 


(A. 68) 


(A. 69) 


and ( i , i ) are time constants for decaying the c and c 
x v J & x v 

quantities . 

Now define the smoothed position and velocity vectors as 


x = x + c 
s r x 


v = v + c 
s r v 


(A. 70) 


As may be seen by inserting Eq . (A. 67) into Eq . (A. 70), 


(x s ) a = (x s>b ’ 


<v s ) a = ( Vb 


(A. 71) 


Thus, the discrete change (dx^dv^) does not cause a jump 

in the smoothed state estimate (x ,v ) used by the pilot and 

s s 

automatic control system. Also, the error state is added in 
a smooth manner using Eqs. (A. 67) and (A. 70) as the c^ and 

c v smoothing vectors decay. The values for the time con- 

stants t x and x were both selected to be 5 sec. 
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Filter Initialization 


The filter mechanization was arranged such that the 
start of initialization or reinitialization occurs consistent 
with that of the existing STOLAND complementary filter. This 
was done to give valid comparison of the performance of the 
two filters during the simulation and flight test phases. 

The initialization of the Kalman filter consists of the 
following: 

(1) setting the position (x,y,z) state variables from 
TACAN and barometric altimeter data, 

(2) setting the velocity (v ,v ,v ) state variables at 

x y z 

the runway referenced true airspeed values (v =0), 

z 

(3) setting wind, acceleration bias, TACAN measurement 
bias and baro-altimeter state variables zero, and 

(4) setting the initial square root matrix in a manner 
consistent with the above. 

The position components are calculated from 


Here, 


x = x^ - r c cos (A\|0 
y = y t - r c sin (Av|/) 


(A. 72) 


r c - y < Y tr> 2 - (h t> 2 - 

h, = altitude above the TACAN station computed 
from barometric altitude, 

- Y tb - +r ' 


The velocity components are given by, 


x 


= Y 


ax 


v 

y 


ay 


v 

z 


0 


(A. 73) 
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The non-zero elements of the initial square root covari- 
ance matrix W for the x-y filter are given by the follow- 
ing: X 




cos(A\|0® r , 


W x (l,2) 


= sin (A«|» )o , 


W x (l,7) 


W x (2,l) 


cos(A»|r)o qr , 


qr 


W (2,2) 

X 


sin(A\l»)a qr , 


W x (3,l) 


(y T ~ y) v 




W x (3,2) 


<V x) V 


W x (3,8) 


V 


W x (4,l) 


(y T- y)o q t ' 


q\l» 


W x (4,2) 


( X T X ^ a q\|/ ’ 


W x (5,3) 


• cos(vl/ . -\1/ )a , a 
VY i va’ va 

(5,4) =-sin(\|/ i -t r )o va , 


W x (6,3) 


v y°*i’ 


O , . 


.(6,4) - 


- v xV’ 


W x (7,3) 


= o 


wx 


wx 


W x (7,9) 


= a 


wx 


W x (8,4) 


= a 


wy 


wy 


W x (8,10) 


= a 


wy ’ 


std of TACAN range bias 
= 305 m. 


std of random noise error 
in the TACAN range meas- 
urement = 37m. 


std of TACAN bearing 
bias = 2 deg- 


std of random noise error 
in TACAN bearing- 


std of random error in 
airspeed measurement = 
0.61 m/sec. 


std of bias error in 
initial heading = 2 deg- 


std of x component of 
wind = 6.1 m/sec. 


std of y component of 
wind = 6.1 m/sec* 
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W (9,5) = a , a = acceleration random 

A ax , y 

error std = .3 m/sec . 

W (10,6) = a , 
x ay ' 

The term \j/^ above is the magnetic heading measurement at the 
time of initialization. 


The non-zero elements of the initial square root covari- 
ance matrix W for the z filter are as follows: 
z 


w z (i,i) 

W z (l,4) 

W z (2,2) 


°hb> 
a hb ’ 


W z (3,3) 


az 


W (4,1) 
z 


hr ’ 


a,, = std for bias error in 

13 baro altitude = 61 m- 


o = std of initial vertical 
v a 

error 

= ( . 3 m/sec) . 

a az = vertical acceleration 
random noise error std 

= .3 m/sec 2 . 

o, = std of random error in 
u baro-alt imeter = 1.2 m. 
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APPENDIX B 


DESCRIPTION OF THE AIRBORNE NAVIGATION SYSTEM 

MECHANIZATION 


The navigation system employing the Kalman filter 
described in Appendix A was designed to operate as an experi- 
ment on the Twin Otter aircraft by using the leftover memory 
and real time of the STOLAND avionics system software. The 
experimental objectives were to compute and record the navi- 
gation outputs from the Kalman filter by using the same raw 
data sources as were used by the STOLAND complementary filter. 
The complementary filter outputs were also computed and re- 
corded at the same time ( in a time-sharing sense) as those of 
the Kalman filter; this allowed a direct comparison of the 
two filters' performances. 

This appendix describes the mechanized Kalman filter 
algorithm logic of the airborne navigation program and the 
executive logic which provided the time-sharing between the 
original STOLAND software and the Kalman filter. 


Executive Driver 

In order to provide the available real time to mechanize 
the Kalman filter logic, it was necessary to develop a new 
executive for the STOLAND software used on the Twin Otter 
aircraft. A macro flowchart of this executive is presented 
in Fig. B.l. At the beginning of program operation, ini- 
tialization logic is executed. The interrupts are then 
enabled, and the Far Background logic is entered. 

In this system, the Far Background logic is used to 
execute lowest priority computations and to mark time until 
various interrupt signals indicate that it is time for faster 
synchronous computations to begin. The program waits in the 
Far Background routine until an interrupt occurs. The 
STOLAND system 1819A computer software contains several 
levels and sources of program interrupt. However, only the 
main stream of calculations, triggered by the 1 kHz internal 
clock and pertinent to the Kalman filter mechanization are 
described here. A clock interrupt causes transfer of program 
operation to a location where a counter is decremented and 
tested to determine if it is time to initiate the 20 Hz cal- 
culations. If not, the program returns to the location where 
interrupted, and it then continues execution. 
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FIGURE B . 1 . - MACRO FLOWCHART OF NEW EXECUTIVE FOR STOLAND 
SOFTWARE TO INCLUDE THE KALMAN FILTER EQUATIONS. 
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If it is time to start the 20 Hz computations, then the 
necessary quantities required for recovery from the interrupt 
(register contents, program location at interrupt) are saved 
in a software push-down stack. The program then executes 
the normal STOLAND (foreground) Twin Otter navigation, guid- 
ance, control and display computations. The STOLAND avionics 
equations are sectioned such that there always remains a 
small essentially unused period of time (> 1 msec) at the 
end of each 50 msec computation cycle. This period was used 
to mechanize the Kalman filter. Following completion of the 
STOLAND Foreground equations, the program executes the logic 
for interfacing the Kalman filter logic and algorithms with 
the STOLAND algorithms. 

The Kalman filter equations are divided into three 
priority levels executed at rates of 20 Hz, 10 Hz and 0.667 Hz. 
These priority levels are summarized in equation form in Table 
2 of Chapter III. They are referred to as Foreground, First 
Level Background, and Second Level Background equations. 

These priority levels are used to allow integrating the 
accelerometer readings at a high rate (10 Hz), and accumu- 
lating the position and air data measurements (fixes) and 
preprocessing them at a lower rate (10 Hz). There was not 
real time available to execute the entire Kalman filter at 
this speed. Thus, the majority of the Kalman filter computa- 
tions are spread over the real time available during a 
1.5 sec period (0.667 Hz). 

Figure B.2 illustrates the cycles used in mechanizing 
the Kalman filter. Also illustrated is the division of time 
spent in each level of computation of five example consecutive 
50 msec computation cycles. The logic which interconnects 
each priority level in the Kalman filter computations is 
explained further in the following discussion. 

Following completion of the Foreground computations, the 
next logic step determines if it is time to start the First 
Level Background (10 Hz) calculations every other cycle of 
the Kalman filter. If not, the executive restores all the 
quantities saved in the push-down stack and branches to the 
saved interrupt location. In this instance, the program 
branches to the higher priority computations in the order: 

(1) 10 Hz (if not complete); (2) 0.667 Hz (if not complete); 
or (3) Far Background. 

If the 10 Hz computations are to be initiated, a marker 
is tested to see if the previous 10 Hz cycle calculations 
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(a) Mechanization Cycles 



(b) Example (Distorted, hypothetical) Time Sharing in Five Consecu- 
tive 50 msec Computation Cycles 


FIGURE B.2.- ILLUSTRATION OF MECHANIZATION CYCLES AND SEQUENTIAL 
PERIODS SPENT IN EACH COMPUTATION LEVEL. 
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were completed before the interrupt. If not, a STOP* is exe- 
cuted because either a software or hardware problem has pre- 
vented completion of the 10 Hz logic within the allowed time. 
With no malfunction, the program proceeds to execute the 10 Hz 
Kalman filter computations shown in Table 2. 

Following completion of the 10 Hz computations, the next 
logic step determines if the Second Level Background (0.667 
Hz) Kalman filter computations shown in Table 2 should be 
initiated. If not, the executive again restores all the 
quantities saved in the push-down stack and branches to the 
saved interrupt location. In this instance, the program 
branches to the higher priority computations in the order: 

(1) 0.667 Hz (if not complete); (2) Far Background. 

If the 0.667 Hz computations (Second Level Background) 
should be initiated, a marker is tested to see whether the 
previous 0.667 Hz cycle computations were completed in the 
allowed time. If not, a STOP is executed indicating that a 
hardware or software problem exists. If no malfunction 
exists, the 0.667 Hz computations are initiated. 

Following completion of the 0.667 Hz computations, the 
executive restores the quantities from the push-down stack 
and branches to the saved location in the Far Background 
coraputat ions . 


Foreground (10 Hz) Logic and Computations 

The Kalman filter logic and computations which are exe- 
cuted at 20 Hz, are shown in Fig. B.3. The first logic test 
determines if artificial data should be generated internally 
for a straight-line path. This logic was used for check-out 
phases, and it is a convenient way of checking the Kalman 
filter operations for new assemblies. 

For normal operation, the logic first transfers the raw 
acceleration data from the STOLAND complementary filter loca- 
tions to the Kalman filter storage locations at a 20 Hz rate. 
Then, a logic test determines if the particular entry is at 
the starting time for a 10 Hz cycle. If true, the navigation 
aid measurements and their validity flags are transferred 


The STOP was only used in the ground tests of the system in 
the STOLAND laboratory. In the airborne mechanization, the 
STOP was replaced with a branch to the RESTORE QUANTITIES 
FROM PUSH DOWN STACK block shown on Fig. B.l. The airborne 
mechanization tries to complete the logic by skipping an 
interval . 
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FIGURE B . 3 . - MACRO FLOW CHART OF KALMAN FILTER 
FOREGROUND LOGIC 



from STOLAND locations used by the complementary filter to 
locations used by the Kalman filter. 

Next, the navigation equations are executed. The first 
operation determines if initialization is required. This 
marker is set true when the regular STOLAND complementary 
filter begins its initialization. If initialization is 
required, then the validity flags for the TACAN data are 
tested. If both the range and bearing are valid, the state 
variables are initialized, and the initialization marker is 
set false. If TACAN data are not valid, the routine returns 
to the main executive program. 

If initialization is not required, the position and 
velocity equations are integrated using the acceleration 
data. Following the integration, a marker is tested to deter- 
mine if a state change (update) is ready. If it is ready, 
then the incremental change is added to the estimated state. 
Then, the program control returns to the main program. 


First Level Background (10 Hz) Logic 
and Computations 

Figure B.4 shows the navigation aid measurement prepro- 
cessing logic which is executed at 10 Hz. A marker is tested 
first to see if the preprocessing logic has been initialized. 
This marker is set true after the state variables have been 
initialized in the Foreground navigation equations (Fig. B.3). 
After initialization (if it is required), the logic does the 
necessary preprocessing for the TACAN, MODILS, air data, and 
radar altimeter measurements as described in Appendix A. 

The transition matrix elements are then updated so the matrix 
is valid for the next entry. 

The incremental state change marker is then tested. If 
true, the residual sums are corrected, and the incremental 
state change is updated with the transition matrix. The 
change ready marker is then set true for use by the Foreground 
logic. 

Next, the residual sum cycle marker is tested. Every 
fifteenth entry (1.5 sec), the marker is set true. Then, the 
residual sums and partials are transferred for use by the 
Second Level Background equations. Following transfer, the 
residual and partial sum locations are cleared, and program 
control returns to the main program. 
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FIGURE B.4.- MACRO FLOWCHART OF FIRST LEVEL 
BACKGROUND LOGIC. 













Second Level Background (0.667 Hz) Logic 
and Computations 

Figure B.5 shows the Kalman filter logic which is exe- 
cuted at 0.667 Hz. The first test determines if initializa- 
tion is required. If true, the square root covariance, 
transition matrix, and forcing function matrix are initial- 
ized, and the initialize marker is set false before return. 

If the initialize marker is false, a test is made to 
determine if there are any measurements (residual sums) to be 
processed. If true, Potter f s algorithm (see Appendix A) is 
used to process each available residual sum in a sequential 
manner. After completion, the incremental state change marker 
is set true for use in the First Level Background logic. 

Finally, the square root matrix is updated to the begin- 
ning of the next measurement accumulation period (see Appendix 
A). Then, program control is again returned to the main 
executive . 
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FIGURE B . 5 . - MACRO FLOWCHART OF THE SECOND LEVEL 
BACKGROUND LOGIC 
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